1ce6e153fSAndrzej Hajda /* 2ce6e153fSAndrzej Hajda * Silicon Image SiI8620 HDMI/MHL bridge driver 3ce6e153fSAndrzej Hajda * 4ce6e153fSAndrzej Hajda * Copyright (C) 2015, Samsung Electronics Co., Ltd. 5ce6e153fSAndrzej Hajda * Andrzej Hajda <a.hajda@samsung.com> 6ce6e153fSAndrzej Hajda * 7ce6e153fSAndrzej Hajda * This program is free software; you can redistribute it and/or modify 8ce6e153fSAndrzej Hajda * it under the terms of the GNU General Public License version 2 as 9ce6e153fSAndrzej Hajda * published by the Free Software Foundation. 10ce6e153fSAndrzej Hajda */ 11ce6e153fSAndrzej Hajda 12e19e9c69SAndrzej Hajda #include <asm/unaligned.h> 13e19e9c69SAndrzej Hajda 14ce6e153fSAndrzej Hajda #include <drm/bridge/mhl.h> 15ce6e153fSAndrzej Hajda #include <drm/drm_crtc.h> 16ce6e153fSAndrzej Hajda #include <drm/drm_edid.h> 17ce6e153fSAndrzej Hajda 18ce6e153fSAndrzej Hajda #include <linux/clk.h> 19ce6e153fSAndrzej Hajda #include <linux/delay.h> 2068883844SMaciej Purski #include <linux/extcon.h> 21ce6e153fSAndrzej Hajda #include <linux/gpio/consumer.h> 22ce6e153fSAndrzej Hajda #include <linux/i2c.h> 23ce6e153fSAndrzej Hajda #include <linux/interrupt.h> 24ce6e153fSAndrzej Hajda #include <linux/irq.h> 25ce6e153fSAndrzej Hajda #include <linux/kernel.h> 26ce6e153fSAndrzej Hajda #include <linux/list.h> 27ce6e153fSAndrzej Hajda #include <linux/module.h> 28ce6e153fSAndrzej Hajda #include <linux/mutex.h> 2968883844SMaciej Purski #include <linux/of_graph.h> 30ce6e153fSAndrzej Hajda #include <linux/regulator/consumer.h> 31ce6e153fSAndrzej Hajda #include <linux/slab.h> 32ce6e153fSAndrzej Hajda 33e25f1f7cSMaciej Purski #include <media/rc-core.h> 34e25f1f7cSMaciej Purski 35ce6e153fSAndrzej Hajda #include "sil-sii8620.h" 36ce6e153fSAndrzej Hajda 37e19e9c69SAndrzej Hajda #define SII8620_BURST_BUF_LEN 288 38ce6e153fSAndrzej Hajda #define VAL_RX_HDMI_CTRL2_DEFVAL VAL_RX_HDMI_CTRL2_IDLE_CNT(3) 39ecba7cfaSMaciej Purski 40ecba7cfaSMaciej Purski #define MHL1_MAX_PCLK 75000 41ecba7cfaSMaciej Purski #define MHL1_MAX_PCLK_PP_MODE 150000 42ecba7cfaSMaciej Purski #define MHL3_MAX_PCLK 200000 43ecba7cfaSMaciej Purski #define MHL3_MAX_PCLK_PP_MODE 300000 44ce6e153fSAndrzej Hajda 45ce6e153fSAndrzej Hajda enum sii8620_mode { 46ce6e153fSAndrzej Hajda CM_DISCONNECTED, 47ce6e153fSAndrzej Hajda CM_DISCOVERY, 48ce6e153fSAndrzej Hajda CM_MHL1, 49ce6e153fSAndrzej Hajda CM_MHL3, 50ce6e153fSAndrzej Hajda CM_ECBUS_S 51ce6e153fSAndrzej Hajda }; 52ce6e153fSAndrzej Hajda 53ce6e153fSAndrzej Hajda enum sii8620_sink_type { 54ce6e153fSAndrzej Hajda SINK_NONE, 55ce6e153fSAndrzej Hajda SINK_HDMI, 56ce6e153fSAndrzej Hajda SINK_DVI 57ce6e153fSAndrzej Hajda }; 58ce6e153fSAndrzej Hajda 59ce6e153fSAndrzej Hajda enum sii8620_mt_state { 60ce6e153fSAndrzej Hajda MT_STATE_READY, 61ce6e153fSAndrzej Hajda MT_STATE_BUSY, 62ce6e153fSAndrzej Hajda MT_STATE_DONE 63ce6e153fSAndrzej Hajda }; 64ce6e153fSAndrzej Hajda 65ce6e153fSAndrzej Hajda struct sii8620 { 66ce6e153fSAndrzej Hajda struct drm_bridge bridge; 67ce6e153fSAndrzej Hajda struct device *dev; 68e25f1f7cSMaciej Purski struct rc_dev *rc_dev; 69ce6e153fSAndrzej Hajda struct clk *clk_xtal; 70ce6e153fSAndrzej Hajda struct gpio_desc *gpio_reset; 71ce6e153fSAndrzej Hajda struct gpio_desc *gpio_int; 72ce6e153fSAndrzej Hajda struct regulator_bulk_data supplies[2]; 73ce6e153fSAndrzej Hajda struct mutex lock; /* context lock, protects fields below */ 74ce6e153fSAndrzej Hajda int error; 75bf1722caSAndrzej Hajda int pixel_clock; 76bf1722caSAndrzej Hajda unsigned int use_packed_pixel:1; 77bf1722caSAndrzej Hajda int video_code; 78ce6e153fSAndrzej Hajda enum sii8620_mode mode; 79ce6e153fSAndrzej Hajda enum sii8620_sink_type sink_type; 80ce6e153fSAndrzej Hajda u8 cbus_status; 81ce6e153fSAndrzej Hajda u8 stat[MHL_DST_SIZE]; 82ce6e153fSAndrzej Hajda u8 xstat[MHL_XDS_SIZE]; 83ce6e153fSAndrzej Hajda u8 devcap[MHL_DCAP_SIZE]; 84ce6e153fSAndrzej Hajda u8 xdevcap[MHL_XDC_SIZE]; 85bf1722caSAndrzej Hajda u8 avif[HDMI_INFOFRAME_SIZE(AVI)]; 86ce6e153fSAndrzej Hajda struct edid *edid; 87ce6e153fSAndrzej Hajda unsigned int gen2_write_burst:1; 88ce6e153fSAndrzej Hajda enum sii8620_mt_state mt_state; 8968883844SMaciej Purski struct extcon_dev *extcon; 9068883844SMaciej Purski struct notifier_block extcon_nb; 9168883844SMaciej Purski struct work_struct extcon_wq; 9268883844SMaciej Purski int cable_state; 93ce6e153fSAndrzej Hajda struct list_head mt_queue; 94e19e9c69SAndrzej Hajda struct { 95e19e9c69SAndrzej Hajda int r_size; 96e19e9c69SAndrzej Hajda int r_count; 97e19e9c69SAndrzej Hajda int rx_ack; 98e19e9c69SAndrzej Hajda int rx_count; 99e19e9c69SAndrzej Hajda u8 rx_buf[32]; 100e19e9c69SAndrzej Hajda int tx_count; 101e19e9c69SAndrzej Hajda u8 tx_buf[32]; 102e19e9c69SAndrzej Hajda } burst; 103ce6e153fSAndrzej Hajda }; 104ce6e153fSAndrzej Hajda 105ce6e153fSAndrzej Hajda struct sii8620_mt_msg; 106ce6e153fSAndrzej Hajda 107ce6e153fSAndrzej Hajda typedef void (*sii8620_mt_msg_cb)(struct sii8620 *ctx, 108ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg); 109ce6e153fSAndrzej Hajda 1100c2d1875SAndrzej Hajda typedef void (*sii8620_cb)(struct sii8620 *ctx, int ret); 1110c2d1875SAndrzej Hajda 112ce6e153fSAndrzej Hajda struct sii8620_mt_msg { 113ce6e153fSAndrzej Hajda struct list_head node; 114ce6e153fSAndrzej Hajda u8 reg[4]; 115ce6e153fSAndrzej Hajda u8 ret; 116ce6e153fSAndrzej Hajda sii8620_mt_msg_cb send; 117ce6e153fSAndrzej Hajda sii8620_mt_msg_cb recv; 1180c2d1875SAndrzej Hajda sii8620_cb continuation; 119ce6e153fSAndrzej Hajda }; 120ce6e153fSAndrzej Hajda 121ce6e153fSAndrzej Hajda static const u8 sii8620_i2c_page[] = { 122ce6e153fSAndrzej Hajda 0x39, /* Main System */ 123ce6e153fSAndrzej Hajda 0x3d, /* TDM and HSIC */ 124ce6e153fSAndrzej Hajda 0x49, /* TMDS Receiver, MHL EDID */ 125ce6e153fSAndrzej Hajda 0x4d, /* eMSC, HDCP, HSIC */ 126ce6e153fSAndrzej Hajda 0x5d, /* MHL Spec */ 127ce6e153fSAndrzej Hajda 0x64, /* MHL CBUS */ 128ce6e153fSAndrzej Hajda 0x59, /* Hardware TPI (Transmitter Programming Interface) */ 129ce6e153fSAndrzej Hajda 0x61, /* eCBUS-S, eCBUS-D */ 130ce6e153fSAndrzej Hajda }; 131ce6e153fSAndrzej Hajda 132ce6e153fSAndrzej Hajda static void sii8620_fetch_edid(struct sii8620 *ctx); 133ce6e153fSAndrzej Hajda static void sii8620_set_upstream_edid(struct sii8620 *ctx); 134ce6e153fSAndrzej Hajda static void sii8620_enable_hpd(struct sii8620 *ctx); 135ce6e153fSAndrzej Hajda static void sii8620_mhl_disconnected(struct sii8620 *ctx); 1362c8fb853SAndrzej Hajda static void sii8620_disconnect(struct sii8620 *ctx); 137ce6e153fSAndrzej Hajda 138ce6e153fSAndrzej Hajda static int sii8620_clear_error(struct sii8620 *ctx) 139ce6e153fSAndrzej Hajda { 140ce6e153fSAndrzej Hajda int ret = ctx->error; 141ce6e153fSAndrzej Hajda 142ce6e153fSAndrzej Hajda ctx->error = 0; 143ce6e153fSAndrzej Hajda return ret; 144ce6e153fSAndrzej Hajda } 145ce6e153fSAndrzej Hajda 146ce6e153fSAndrzej Hajda static void sii8620_read_buf(struct sii8620 *ctx, u16 addr, u8 *buf, int len) 147ce6e153fSAndrzej Hajda { 148ce6e153fSAndrzej Hajda struct device *dev = ctx->dev; 149ce6e153fSAndrzej Hajda struct i2c_client *client = to_i2c_client(dev); 150ce6e153fSAndrzej Hajda u8 data = addr; 151ce6e153fSAndrzej Hajda struct i2c_msg msg[] = { 152ce6e153fSAndrzej Hajda { 153ce6e153fSAndrzej Hajda .addr = sii8620_i2c_page[addr >> 8], 154ce6e153fSAndrzej Hajda .flags = client->flags, 155ce6e153fSAndrzej Hajda .len = 1, 156ce6e153fSAndrzej Hajda .buf = &data 157ce6e153fSAndrzej Hajda }, 158ce6e153fSAndrzej Hajda { 159ce6e153fSAndrzej Hajda .addr = sii8620_i2c_page[addr >> 8], 160ce6e153fSAndrzej Hajda .flags = client->flags | I2C_M_RD, 161ce6e153fSAndrzej Hajda .len = len, 162ce6e153fSAndrzej Hajda .buf = buf 163ce6e153fSAndrzej Hajda }, 164ce6e153fSAndrzej Hajda }; 165ce6e153fSAndrzej Hajda int ret; 166ce6e153fSAndrzej Hajda 167ce6e153fSAndrzej Hajda if (ctx->error) 168ce6e153fSAndrzej Hajda return; 169ce6e153fSAndrzej Hajda 170ce6e153fSAndrzej Hajda ret = i2c_transfer(client->adapter, msg, 2); 171ce6e153fSAndrzej Hajda dev_dbg(dev, "read at %04x: %*ph, %d\n", addr, len, buf, ret); 172ce6e153fSAndrzej Hajda 173ce6e153fSAndrzej Hajda if (ret != 2) { 174ce6e153fSAndrzej Hajda dev_err(dev, "Read at %#06x of %d bytes failed with code %d.\n", 175ce6e153fSAndrzej Hajda addr, len, ret); 176ce6e153fSAndrzej Hajda ctx->error = ret < 0 ? ret : -EIO; 177ce6e153fSAndrzej Hajda } 178ce6e153fSAndrzej Hajda } 179ce6e153fSAndrzej Hajda 180ce6e153fSAndrzej Hajda static u8 sii8620_readb(struct sii8620 *ctx, u16 addr) 181ce6e153fSAndrzej Hajda { 182ce6e153fSAndrzej Hajda u8 ret; 183ce6e153fSAndrzej Hajda 184ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, addr, &ret, 1); 185ce6e153fSAndrzej Hajda return ret; 186ce6e153fSAndrzej Hajda } 187ce6e153fSAndrzej Hajda 188ce6e153fSAndrzej Hajda static void sii8620_write_buf(struct sii8620 *ctx, u16 addr, const u8 *buf, 189ce6e153fSAndrzej Hajda int len) 190ce6e153fSAndrzej Hajda { 191ce6e153fSAndrzej Hajda struct device *dev = ctx->dev; 192ce6e153fSAndrzej Hajda struct i2c_client *client = to_i2c_client(dev); 193ce6e153fSAndrzej Hajda u8 data[2]; 194ce6e153fSAndrzej Hajda struct i2c_msg msg = { 195ce6e153fSAndrzej Hajda .addr = sii8620_i2c_page[addr >> 8], 196ce6e153fSAndrzej Hajda .flags = client->flags, 197ce6e153fSAndrzej Hajda .len = len + 1, 198ce6e153fSAndrzej Hajda }; 199ce6e153fSAndrzej Hajda int ret; 200ce6e153fSAndrzej Hajda 201ce6e153fSAndrzej Hajda if (ctx->error) 202ce6e153fSAndrzej Hajda return; 203ce6e153fSAndrzej Hajda 204ce6e153fSAndrzej Hajda if (len > 1) { 205ce6e153fSAndrzej Hajda msg.buf = kmalloc(len + 1, GFP_KERNEL); 206ce6e153fSAndrzej Hajda if (!msg.buf) { 207ce6e153fSAndrzej Hajda ctx->error = -ENOMEM; 208ce6e153fSAndrzej Hajda return; 209ce6e153fSAndrzej Hajda } 210ce6e153fSAndrzej Hajda memcpy(msg.buf + 1, buf, len); 211ce6e153fSAndrzej Hajda } else { 212ce6e153fSAndrzej Hajda msg.buf = data; 213ce6e153fSAndrzej Hajda msg.buf[1] = *buf; 214ce6e153fSAndrzej Hajda } 215ce6e153fSAndrzej Hajda 216ce6e153fSAndrzej Hajda msg.buf[0] = addr; 217ce6e153fSAndrzej Hajda 218ce6e153fSAndrzej Hajda ret = i2c_transfer(client->adapter, &msg, 1); 219ce6e153fSAndrzej Hajda dev_dbg(dev, "write at %04x: %*ph, %d\n", addr, len, buf, ret); 220ce6e153fSAndrzej Hajda 221ce6e153fSAndrzej Hajda if (ret != 1) { 222ce6e153fSAndrzej Hajda dev_err(dev, "Write at %#06x of %*ph failed with code %d.\n", 223ce6e153fSAndrzej Hajda addr, len, buf, ret); 224ce6e153fSAndrzej Hajda ctx->error = ret ?: -EIO; 225ce6e153fSAndrzej Hajda } 226ce6e153fSAndrzej Hajda 227ce6e153fSAndrzej Hajda if (len > 1) 228ce6e153fSAndrzej Hajda kfree(msg.buf); 229ce6e153fSAndrzej Hajda } 230ce6e153fSAndrzej Hajda 231ce6e153fSAndrzej Hajda #define sii8620_write(ctx, addr, arr...) \ 232ce6e153fSAndrzej Hajda ({\ 233ce6e153fSAndrzej Hajda u8 d[] = { arr }; \ 234ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, addr, d, ARRAY_SIZE(d)); \ 235ce6e153fSAndrzej Hajda }) 236ce6e153fSAndrzej Hajda 237ce6e153fSAndrzej Hajda static void __sii8620_write_seq(struct sii8620 *ctx, const u16 *seq, int len) 238ce6e153fSAndrzej Hajda { 239ce6e153fSAndrzej Hajda int i; 240ce6e153fSAndrzej Hajda 241ce6e153fSAndrzej Hajda for (i = 0; i < len; i += 2) 242ce6e153fSAndrzej Hajda sii8620_write(ctx, seq[i], seq[i + 1]); 243ce6e153fSAndrzej Hajda } 244ce6e153fSAndrzej Hajda 245ce6e153fSAndrzej Hajda #define sii8620_write_seq(ctx, seq...) \ 246ce6e153fSAndrzej Hajda ({\ 247ce6e153fSAndrzej Hajda const u16 d[] = { seq }; \ 248ce6e153fSAndrzej Hajda __sii8620_write_seq(ctx, d, ARRAY_SIZE(d)); \ 249ce6e153fSAndrzej Hajda }) 250ce6e153fSAndrzej Hajda 251ce6e153fSAndrzej Hajda #define sii8620_write_seq_static(ctx, seq...) \ 252ce6e153fSAndrzej Hajda ({\ 253ce6e153fSAndrzej Hajda static const u16 d[] = { seq }; \ 254ce6e153fSAndrzej Hajda __sii8620_write_seq(ctx, d, ARRAY_SIZE(d)); \ 255ce6e153fSAndrzej Hajda }) 256ce6e153fSAndrzej Hajda 257ce6e153fSAndrzej Hajda static void sii8620_setbits(struct sii8620 *ctx, u16 addr, u8 mask, u8 val) 258ce6e153fSAndrzej Hajda { 259ce6e153fSAndrzej Hajda val = (val & mask) | (sii8620_readb(ctx, addr) & ~mask); 260ce6e153fSAndrzej Hajda sii8620_write(ctx, addr, val); 261ce6e153fSAndrzej Hajda } 262ce6e153fSAndrzej Hajda 263bb4954c7SAndrzej Hajda static inline bool sii8620_is_mhl3(struct sii8620 *ctx) 264bb4954c7SAndrzej Hajda { 265bb4954c7SAndrzej Hajda return ctx->mode >= CM_MHL3; 266bb4954c7SAndrzej Hajda } 267bb4954c7SAndrzej Hajda 268ce6e153fSAndrzej Hajda static void sii8620_mt_cleanup(struct sii8620 *ctx) 269ce6e153fSAndrzej Hajda { 270ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg, *n; 271ce6e153fSAndrzej Hajda 272ce6e153fSAndrzej Hajda list_for_each_entry_safe(msg, n, &ctx->mt_queue, node) { 273ce6e153fSAndrzej Hajda list_del(&msg->node); 274ce6e153fSAndrzej Hajda kfree(msg); 275ce6e153fSAndrzej Hajda } 276ce6e153fSAndrzej Hajda ctx->mt_state = MT_STATE_READY; 277ce6e153fSAndrzej Hajda } 278ce6e153fSAndrzej Hajda 279ce6e153fSAndrzej Hajda static void sii8620_mt_work(struct sii8620 *ctx) 280ce6e153fSAndrzej Hajda { 281ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg; 282ce6e153fSAndrzej Hajda 283ce6e153fSAndrzej Hajda if (ctx->error) 284ce6e153fSAndrzej Hajda return; 285ce6e153fSAndrzej Hajda if (ctx->mt_state == MT_STATE_BUSY || list_empty(&ctx->mt_queue)) 286ce6e153fSAndrzej Hajda return; 287ce6e153fSAndrzej Hajda 288ce6e153fSAndrzej Hajda if (ctx->mt_state == MT_STATE_DONE) { 289ce6e153fSAndrzej Hajda ctx->mt_state = MT_STATE_READY; 290ce6e153fSAndrzej Hajda msg = list_first_entry(&ctx->mt_queue, struct sii8620_mt_msg, 291ce6e153fSAndrzej Hajda node); 292d6d59c5aSAndrzej Hajda list_del(&msg->node); 293ce6e153fSAndrzej Hajda if (msg->recv) 294ce6e153fSAndrzej Hajda msg->recv(ctx, msg); 2950c2d1875SAndrzej Hajda if (msg->continuation) 2960c2d1875SAndrzej Hajda msg->continuation(ctx, msg->ret); 297ce6e153fSAndrzej Hajda kfree(msg); 298ce6e153fSAndrzej Hajda } 299ce6e153fSAndrzej Hajda 300ce6e153fSAndrzej Hajda if (ctx->mt_state != MT_STATE_READY || list_empty(&ctx->mt_queue)) 301ce6e153fSAndrzej Hajda return; 302ce6e153fSAndrzej Hajda 303ce6e153fSAndrzej Hajda ctx->mt_state = MT_STATE_BUSY; 304ce6e153fSAndrzej Hajda msg = list_first_entry(&ctx->mt_queue, struct sii8620_mt_msg, node); 305ce6e153fSAndrzej Hajda if (msg->send) 306ce6e153fSAndrzej Hajda msg->send(ctx, msg); 307ce6e153fSAndrzej Hajda } 308ce6e153fSAndrzej Hajda 30926a4cef8SAndrzej Hajda static void sii8620_enable_gen2_write_burst(struct sii8620 *ctx) 31026a4cef8SAndrzej Hajda { 31126a4cef8SAndrzej Hajda u8 ctrl = BIT_MDT_RCV_CTRL_MDT_RCV_EN; 31226a4cef8SAndrzej Hajda 31326a4cef8SAndrzej Hajda if (ctx->gen2_write_burst) 31426a4cef8SAndrzej Hajda return; 31526a4cef8SAndrzej Hajda 31626a4cef8SAndrzej Hajda if (ctx->mode >= CM_MHL1) 31726a4cef8SAndrzej Hajda ctrl |= BIT_MDT_RCV_CTRL_MDT_DELAY_RCV_EN; 31826a4cef8SAndrzej Hajda 31926a4cef8SAndrzej Hajda sii8620_write_seq(ctx, 32026a4cef8SAndrzej Hajda REG_MDT_RCV_TIMEOUT, 100, 32126a4cef8SAndrzej Hajda REG_MDT_RCV_CTRL, ctrl 32226a4cef8SAndrzej Hajda ); 32326a4cef8SAndrzej Hajda ctx->gen2_write_burst = 1; 32426a4cef8SAndrzej Hajda } 32526a4cef8SAndrzej Hajda 32626a4cef8SAndrzej Hajda static void sii8620_disable_gen2_write_burst(struct sii8620 *ctx) 32726a4cef8SAndrzej Hajda { 32826a4cef8SAndrzej Hajda if (!ctx->gen2_write_burst) 32926a4cef8SAndrzej Hajda return; 33026a4cef8SAndrzej Hajda 33126a4cef8SAndrzej Hajda sii8620_write_seq_static(ctx, 33226a4cef8SAndrzej Hajda REG_MDT_XMIT_CTRL, 0, 33326a4cef8SAndrzej Hajda REG_MDT_RCV_CTRL, 0 33426a4cef8SAndrzej Hajda ); 33526a4cef8SAndrzej Hajda ctx->gen2_write_burst = 0; 33626a4cef8SAndrzej Hajda } 33726a4cef8SAndrzej Hajda 33826a4cef8SAndrzej Hajda static void sii8620_start_gen2_write_burst(struct sii8620 *ctx) 33926a4cef8SAndrzej Hajda { 34026a4cef8SAndrzej Hajda sii8620_write_seq_static(ctx, 34126a4cef8SAndrzej Hajda REG_MDT_INT_1_MASK, BIT_MDT_RCV_TIMEOUT 34226a4cef8SAndrzej Hajda | BIT_MDT_RCV_SM_ABORT_PKT_RCVD | BIT_MDT_RCV_SM_ERROR 34326a4cef8SAndrzej Hajda | BIT_MDT_XMIT_TIMEOUT | BIT_MDT_XMIT_SM_ABORT_PKT_RCVD 34426a4cef8SAndrzej Hajda | BIT_MDT_XMIT_SM_ERROR, 34526a4cef8SAndrzej Hajda REG_MDT_INT_0_MASK, BIT_MDT_XFIFO_EMPTY 34626a4cef8SAndrzej Hajda | BIT_MDT_IDLE_AFTER_HAWB_DISABLE 34726a4cef8SAndrzej Hajda | BIT_MDT_RFIFO_DATA_RDY 34826a4cef8SAndrzej Hajda ); 34926a4cef8SAndrzej Hajda sii8620_enable_gen2_write_burst(ctx); 35026a4cef8SAndrzej Hajda } 35126a4cef8SAndrzej Hajda 352ce6e153fSAndrzej Hajda static void sii8620_mt_msc_cmd_send(struct sii8620 *ctx, 353ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg) 354ce6e153fSAndrzej Hajda { 35526a4cef8SAndrzej Hajda if (msg->reg[0] == MHL_SET_INT && 35626a4cef8SAndrzej Hajda msg->reg[1] == MHL_INT_REG(RCHANGE) && 35726a4cef8SAndrzej Hajda msg->reg[2] == MHL_INT_RC_FEAT_REQ) 35826a4cef8SAndrzej Hajda sii8620_enable_gen2_write_burst(ctx); 35926a4cef8SAndrzej Hajda else 36026a4cef8SAndrzej Hajda sii8620_disable_gen2_write_burst(ctx); 36126a4cef8SAndrzej Hajda 362ce6e153fSAndrzej Hajda switch (msg->reg[0]) { 363ce6e153fSAndrzej Hajda case MHL_WRITE_STAT: 364ce6e153fSAndrzej Hajda case MHL_SET_INT: 365ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, REG_MSC_CMD_OR_OFFSET, msg->reg + 1, 2); 366ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_MSC_COMMAND_START, 367ce6e153fSAndrzej Hajda BIT_MSC_COMMAND_START_WRITE_STAT); 368ce6e153fSAndrzej Hajda break; 369ce6e153fSAndrzej Hajda case MHL_MSC_MSG: 370ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, REG_MSC_CMD_OR_OFFSET, msg->reg, 3); 371ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_MSC_COMMAND_START, 372ce6e153fSAndrzej Hajda BIT_MSC_COMMAND_START_MSC_MSG); 373ce6e153fSAndrzej Hajda break; 374e9c6da27SAndrzej Hajda case MHL_READ_DEVCAP_REG: 375e9c6da27SAndrzej Hajda case MHL_READ_XDEVCAP_REG: 376e9c6da27SAndrzej Hajda sii8620_write(ctx, REG_MSC_CMD_OR_OFFSET, msg->reg[1]); 377e9c6da27SAndrzej Hajda sii8620_write(ctx, REG_MSC_COMMAND_START, 378e9c6da27SAndrzej Hajda BIT_MSC_COMMAND_START_READ_DEVCAP); 379e9c6da27SAndrzej Hajda break; 380ce6e153fSAndrzej Hajda default: 381ce6e153fSAndrzej Hajda dev_err(ctx->dev, "%s: command %#x not supported\n", __func__, 382ce6e153fSAndrzej Hajda msg->reg[0]); 383ce6e153fSAndrzej Hajda } 384ce6e153fSAndrzej Hajda } 385ce6e153fSAndrzej Hajda 386ce6e153fSAndrzej Hajda static struct sii8620_mt_msg *sii8620_mt_msg_new(struct sii8620 *ctx) 387ce6e153fSAndrzej Hajda { 388ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg = kzalloc(sizeof(*msg), GFP_KERNEL); 389ce6e153fSAndrzej Hajda 390ce6e153fSAndrzej Hajda if (!msg) 391ce6e153fSAndrzej Hajda ctx->error = -ENOMEM; 392ce6e153fSAndrzej Hajda else 393ce6e153fSAndrzej Hajda list_add_tail(&msg->node, &ctx->mt_queue); 394ce6e153fSAndrzej Hajda 395ce6e153fSAndrzej Hajda return msg; 396ce6e153fSAndrzej Hajda } 397ce6e153fSAndrzej Hajda 3980c2d1875SAndrzej Hajda static void sii8620_mt_set_cont(struct sii8620 *ctx, sii8620_cb cont) 3990c2d1875SAndrzej Hajda { 4000c2d1875SAndrzej Hajda struct sii8620_mt_msg *msg; 4010c2d1875SAndrzej Hajda 4020c2d1875SAndrzej Hajda if (ctx->error) 4030c2d1875SAndrzej Hajda return; 4040c2d1875SAndrzej Hajda 4050c2d1875SAndrzej Hajda if (list_empty(&ctx->mt_queue)) { 4060c2d1875SAndrzej Hajda ctx->error = -EINVAL; 4070c2d1875SAndrzej Hajda return; 4080c2d1875SAndrzej Hajda } 4090c2d1875SAndrzej Hajda msg = list_last_entry(&ctx->mt_queue, struct sii8620_mt_msg, node); 4100c2d1875SAndrzej Hajda msg->continuation = cont; 4110c2d1875SAndrzej Hajda } 4120c2d1875SAndrzej Hajda 413ce6e153fSAndrzej Hajda static void sii8620_mt_msc_cmd(struct sii8620 *ctx, u8 cmd, u8 arg1, u8 arg2) 414ce6e153fSAndrzej Hajda { 415ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg = sii8620_mt_msg_new(ctx); 416ce6e153fSAndrzej Hajda 417ce6e153fSAndrzej Hajda if (!msg) 418ce6e153fSAndrzej Hajda return; 419ce6e153fSAndrzej Hajda 420ce6e153fSAndrzej Hajda msg->reg[0] = cmd; 421ce6e153fSAndrzej Hajda msg->reg[1] = arg1; 422ce6e153fSAndrzej Hajda msg->reg[2] = arg2; 423ce6e153fSAndrzej Hajda msg->send = sii8620_mt_msc_cmd_send; 424ce6e153fSAndrzej Hajda } 425ce6e153fSAndrzej Hajda 426ce6e153fSAndrzej Hajda static void sii8620_mt_write_stat(struct sii8620 *ctx, u8 reg, u8 val) 427ce6e153fSAndrzej Hajda { 428ce6e153fSAndrzej Hajda sii8620_mt_msc_cmd(ctx, MHL_WRITE_STAT, reg, val); 429ce6e153fSAndrzej Hajda } 430ce6e153fSAndrzej Hajda 431ce6e153fSAndrzej Hajda static inline void sii8620_mt_set_int(struct sii8620 *ctx, u8 irq, u8 mask) 432ce6e153fSAndrzej Hajda { 433ce6e153fSAndrzej Hajda sii8620_mt_msc_cmd(ctx, MHL_SET_INT, irq, mask); 434ce6e153fSAndrzej Hajda } 435ce6e153fSAndrzej Hajda 436ce6e153fSAndrzej Hajda static void sii8620_mt_msc_msg(struct sii8620 *ctx, u8 cmd, u8 data) 437ce6e153fSAndrzej Hajda { 438ce6e153fSAndrzej Hajda sii8620_mt_msc_cmd(ctx, MHL_MSC_MSG, cmd, data); 439ce6e153fSAndrzej Hajda } 440ce6e153fSAndrzej Hajda 441ce6e153fSAndrzej Hajda static void sii8620_mt_rap(struct sii8620 *ctx, u8 code) 442ce6e153fSAndrzej Hajda { 443ce6e153fSAndrzej Hajda sii8620_mt_msc_msg(ctx, MHL_MSC_MSG_RAP, code); 444ce6e153fSAndrzej Hajda } 445ce6e153fSAndrzej Hajda 446e25f1f7cSMaciej Purski static void sii8620_mt_rcpk(struct sii8620 *ctx, u8 code) 447e25f1f7cSMaciej Purski { 448e25f1f7cSMaciej Purski sii8620_mt_msc_msg(ctx, MHL_MSC_MSG_RCPK, code); 449e25f1f7cSMaciej Purski } 450e25f1f7cSMaciej Purski 451e25f1f7cSMaciej Purski static void sii8620_mt_rcpe(struct sii8620 *ctx, u8 code) 452e25f1f7cSMaciej Purski { 453e25f1f7cSMaciej Purski sii8620_mt_msc_msg(ctx, MHL_MSC_MSG_RCPE, code); 454e25f1f7cSMaciej Purski } 455e25f1f7cSMaciej Purski 456ce6e153fSAndrzej Hajda static void sii8620_mt_read_devcap_send(struct sii8620 *ctx, 457ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg) 458ce6e153fSAndrzej Hajda { 459ce6e153fSAndrzej Hajda u8 ctrl = BIT_EDID_CTRL_DEVCAP_SELECT_DEVCAP 460ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_FIFO_ADDR_AUTO 461ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_MODE_EN; 462ce6e153fSAndrzej Hajda 463ce6e153fSAndrzej Hajda if (msg->reg[0] == MHL_READ_XDEVCAP) 464ce6e153fSAndrzej Hajda ctrl |= BIT_EDID_CTRL_XDEVCAP_EN; 465ce6e153fSAndrzej Hajda 466ce6e153fSAndrzej Hajda sii8620_write_seq(ctx, 467ce6e153fSAndrzej Hajda REG_INTR9_MASK, BIT_INTR9_DEVCAP_DONE, 468ce6e153fSAndrzej Hajda REG_EDID_CTRL, ctrl, 469ce6e153fSAndrzej Hajda REG_TPI_CBUS_START, BIT_TPI_CBUS_START_GET_DEVCAP_START 470ce6e153fSAndrzej Hajda ); 471ce6e153fSAndrzej Hajda } 472ce6e153fSAndrzej Hajda 473ce6e153fSAndrzej Hajda /* copy src to dst and set changed bits in src */ 474ce6e153fSAndrzej Hajda static void sii8620_update_array(u8 *dst, u8 *src, int count) 475ce6e153fSAndrzej Hajda { 476ce6e153fSAndrzej Hajda while (--count >= 0) { 477ce6e153fSAndrzej Hajda *src ^= *dst; 478ce6e153fSAndrzej Hajda *dst++ ^= *src++; 479ce6e153fSAndrzej Hajda } 480ce6e153fSAndrzej Hajda } 481ce6e153fSAndrzej Hajda 4829a466cd1SAndrzej Hajda static void sii8620_sink_detected(struct sii8620 *ctx, int ret) 483ce6e153fSAndrzej Hajda { 484ce6e153fSAndrzej Hajda static const char * const sink_str[] = { 485ce6e153fSAndrzej Hajda [SINK_NONE] = "NONE", 486ce6e153fSAndrzej Hajda [SINK_HDMI] = "HDMI", 487ce6e153fSAndrzej Hajda [SINK_DVI] = "DVI" 488ce6e153fSAndrzej Hajda }; 489ce6e153fSAndrzej Hajda 490ce6e153fSAndrzej Hajda char sink_name[20]; 491ce6e153fSAndrzej Hajda struct device *dev = ctx->dev; 492ce6e153fSAndrzej Hajda 4939a466cd1SAndrzej Hajda if (ret < 0) 494ce6e153fSAndrzej Hajda return; 495ce6e153fSAndrzej Hajda 496ce6e153fSAndrzej Hajda sii8620_fetch_edid(ctx); 497ce6e153fSAndrzej Hajda if (!ctx->edid) { 498ce6e153fSAndrzej Hajda dev_err(ctx->dev, "Cannot fetch EDID\n"); 499ce6e153fSAndrzej Hajda sii8620_mhl_disconnected(ctx); 500ce6e153fSAndrzej Hajda return; 501ce6e153fSAndrzej Hajda } 502ce6e153fSAndrzej Hajda 503ce6e153fSAndrzej Hajda if (drm_detect_hdmi_monitor(ctx->edid)) 504ce6e153fSAndrzej Hajda ctx->sink_type = SINK_HDMI; 505ce6e153fSAndrzej Hajda else 506ce6e153fSAndrzej Hajda ctx->sink_type = SINK_DVI; 507ce6e153fSAndrzej Hajda 508ce6e153fSAndrzej Hajda drm_edid_get_monitor_name(ctx->edid, sink_name, ARRAY_SIZE(sink_name)); 509ce6e153fSAndrzej Hajda 510ce6e153fSAndrzej Hajda dev_info(dev, "detected sink(type: %s): %s\n", 511ce6e153fSAndrzej Hajda sink_str[ctx->sink_type], sink_name); 512263b5c93SAndrzej Hajda } 513263b5c93SAndrzej Hajda 514a21e658bSAndrzej Hajda static void sii8620_hsic_init(struct sii8620 *ctx) 515a21e658bSAndrzej Hajda { 516a21e658bSAndrzej Hajda if (!sii8620_is_mhl3(ctx)) 517a21e658bSAndrzej Hajda return; 518a21e658bSAndrzej Hajda 519a21e658bSAndrzej Hajda sii8620_write(ctx, REG_FCGC, 520a21e658bSAndrzej Hajda BIT_FCGC_HSIC_HOSTMODE | BIT_FCGC_HSIC_ENABLE); 521a21e658bSAndrzej Hajda sii8620_setbits(ctx, REG_HRXCTRL3, 522a21e658bSAndrzej Hajda BIT_HRXCTRL3_HRX_STAY_RESET | BIT_HRXCTRL3_STATUS_EN, ~0); 523a21e658bSAndrzej Hajda sii8620_setbits(ctx, REG_TTXNUMB, MSK_TTXNUMB_TTX_NUMBPS, 4); 524a21e658bSAndrzej Hajda sii8620_setbits(ctx, REG_TRXCTRL, BIT_TRXCTRL_TRX_FROM_SE_COC, ~0); 525a21e658bSAndrzej Hajda sii8620_setbits(ctx, REG_HTXCTRL, BIT_HTXCTRL_HTX_DRVCONN1, 0); 526a21e658bSAndrzej Hajda sii8620_setbits(ctx, REG_KEEPER, MSK_KEEPER_MODE, VAL_KEEPER_MODE_HOST); 527a21e658bSAndrzej Hajda sii8620_write_seq_static(ctx, 528a21e658bSAndrzej Hajda REG_TDMLLCTL, 0, 529a21e658bSAndrzej Hajda REG_UTSRST, BIT_UTSRST_HRX_SRST | BIT_UTSRST_HTX_SRST | 530a21e658bSAndrzej Hajda BIT_UTSRST_KEEPER_SRST | BIT_UTSRST_FC_SRST, 531a21e658bSAndrzej Hajda REG_UTSRST, BIT_UTSRST_HRX_SRST | BIT_UTSRST_HTX_SRST, 532a21e658bSAndrzej Hajda REG_HRXINTL, 0xff, 533a21e658bSAndrzej Hajda REG_HRXINTH, 0xff, 534a21e658bSAndrzej Hajda REG_TTXINTL, 0xff, 535a21e658bSAndrzej Hajda REG_TTXINTH, 0xff, 536a21e658bSAndrzej Hajda REG_TRXINTL, 0xff, 537a21e658bSAndrzej Hajda REG_TRXINTH, 0xff, 538a21e658bSAndrzej Hajda REG_HTXINTL, 0xff, 539a21e658bSAndrzej Hajda REG_HTXINTH, 0xff, 540a21e658bSAndrzej Hajda REG_FCINTR0, 0xff, 541a21e658bSAndrzej Hajda REG_FCINTR1, 0xff, 542a21e658bSAndrzej Hajda REG_FCINTR2, 0xff, 543a21e658bSAndrzej Hajda REG_FCINTR3, 0xff, 544a21e658bSAndrzej Hajda REG_FCINTR4, 0xff, 545a21e658bSAndrzej Hajda REG_FCINTR5, 0xff, 546a21e658bSAndrzej Hajda REG_FCINTR6, 0xff, 547a21e658bSAndrzej Hajda REG_FCINTR7, 0xff 548a21e658bSAndrzej Hajda ); 549a21e658bSAndrzej Hajda } 550a21e658bSAndrzej Hajda 551263b5c93SAndrzej Hajda static void sii8620_edid_read(struct sii8620 *ctx, int ret) 552263b5c93SAndrzej Hajda { 553263b5c93SAndrzej Hajda if (ret < 0) 554263b5c93SAndrzej Hajda return; 555263b5c93SAndrzej Hajda 556ce6e153fSAndrzej Hajda sii8620_set_upstream_edid(ctx); 557a21e658bSAndrzej Hajda sii8620_hsic_init(ctx); 558ce6e153fSAndrzej Hajda sii8620_enable_hpd(ctx); 559ce6e153fSAndrzej Hajda } 560ce6e153fSAndrzej Hajda 5619a466cd1SAndrzej Hajda static void sii8620_mr_devcap(struct sii8620 *ctx) 5629a466cd1SAndrzej Hajda { 5639a466cd1SAndrzej Hajda u8 dcap[MHL_DCAP_SIZE]; 5649a466cd1SAndrzej Hajda struct device *dev = ctx->dev; 5659a466cd1SAndrzej Hajda 5669a466cd1SAndrzej Hajda sii8620_read_buf(ctx, REG_EDID_FIFO_RD_DATA, dcap, MHL_DCAP_SIZE); 5679a466cd1SAndrzej Hajda if (ctx->error < 0) 5689a466cd1SAndrzej Hajda return; 5699a466cd1SAndrzej Hajda 5709a466cd1SAndrzej Hajda dev_info(dev, "detected dongle MHL %d.%d, ChipID %02x%02x:%02x%02x\n", 5719a466cd1SAndrzej Hajda dcap[MHL_DCAP_MHL_VERSION] / 16, 5729a466cd1SAndrzej Hajda dcap[MHL_DCAP_MHL_VERSION] % 16, 5739a466cd1SAndrzej Hajda dcap[MHL_DCAP_ADOPTER_ID_H], dcap[MHL_DCAP_ADOPTER_ID_L], 5749a466cd1SAndrzej Hajda dcap[MHL_DCAP_DEVICE_ID_H], dcap[MHL_DCAP_DEVICE_ID_L]); 5759a466cd1SAndrzej Hajda sii8620_update_array(ctx->devcap, dcap, MHL_DCAP_SIZE); 5769a466cd1SAndrzej Hajda } 5779a466cd1SAndrzej Hajda 578ce6e153fSAndrzej Hajda static void sii8620_mr_xdevcap(struct sii8620 *ctx) 579ce6e153fSAndrzej Hajda { 580ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_EDID_FIFO_RD_DATA, ctx->xdevcap, 581ce6e153fSAndrzej Hajda MHL_XDC_SIZE); 582ce6e153fSAndrzej Hajda } 583ce6e153fSAndrzej Hajda 584ce6e153fSAndrzej Hajda static void sii8620_mt_read_devcap_recv(struct sii8620 *ctx, 585ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg) 586ce6e153fSAndrzej Hajda { 587ce6e153fSAndrzej Hajda u8 ctrl = BIT_EDID_CTRL_DEVCAP_SELECT_DEVCAP 588ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_FIFO_ADDR_AUTO 589ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_MODE_EN; 590ce6e153fSAndrzej Hajda 591ce6e153fSAndrzej Hajda if (msg->reg[0] == MHL_READ_XDEVCAP) 592ce6e153fSAndrzej Hajda ctrl |= BIT_EDID_CTRL_XDEVCAP_EN; 593ce6e153fSAndrzej Hajda 594ce6e153fSAndrzej Hajda sii8620_write_seq(ctx, 595ce6e153fSAndrzej Hajda REG_INTR9_MASK, BIT_INTR9_DEVCAP_DONE | BIT_INTR9_EDID_DONE 596ce6e153fSAndrzej Hajda | BIT_INTR9_EDID_ERROR, 597ce6e153fSAndrzej Hajda REG_EDID_CTRL, ctrl, 598ce6e153fSAndrzej Hajda REG_EDID_FIFO_ADDR, 0 599ce6e153fSAndrzej Hajda ); 600ce6e153fSAndrzej Hajda 601ce6e153fSAndrzej Hajda if (msg->reg[0] == MHL_READ_XDEVCAP) 602ce6e153fSAndrzej Hajda sii8620_mr_xdevcap(ctx); 603ce6e153fSAndrzej Hajda else 604ce6e153fSAndrzej Hajda sii8620_mr_devcap(ctx); 605ce6e153fSAndrzej Hajda } 606ce6e153fSAndrzej Hajda 607ce6e153fSAndrzej Hajda static void sii8620_mt_read_devcap(struct sii8620 *ctx, bool xdevcap) 608ce6e153fSAndrzej Hajda { 609ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg = sii8620_mt_msg_new(ctx); 610ce6e153fSAndrzej Hajda 611ce6e153fSAndrzej Hajda if (!msg) 612ce6e153fSAndrzej Hajda return; 613ce6e153fSAndrzej Hajda 614ce6e153fSAndrzej Hajda msg->reg[0] = xdevcap ? MHL_READ_XDEVCAP : MHL_READ_DEVCAP; 615ce6e153fSAndrzej Hajda msg->send = sii8620_mt_read_devcap_send; 616ce6e153fSAndrzej Hajda msg->recv = sii8620_mt_read_devcap_recv; 617ce6e153fSAndrzej Hajda } 618ce6e153fSAndrzej Hajda 619e9c6da27SAndrzej Hajda static void sii8620_mt_read_devcap_reg_recv(struct sii8620 *ctx, 620e9c6da27SAndrzej Hajda struct sii8620_mt_msg *msg) 621e9c6da27SAndrzej Hajda { 62279964dbaSMaciej Purski u8 reg = msg->reg[1] & 0x7f; 623e9c6da27SAndrzej Hajda 62479964dbaSMaciej Purski if (msg->reg[1] & 0x80) 625e9c6da27SAndrzej Hajda ctx->xdevcap[reg] = msg->ret; 626e9c6da27SAndrzej Hajda else 627e9c6da27SAndrzej Hajda ctx->devcap[reg] = msg->ret; 628e9c6da27SAndrzej Hajda } 629e9c6da27SAndrzej Hajda 630e9c6da27SAndrzej Hajda static void sii8620_mt_read_devcap_reg(struct sii8620 *ctx, u8 reg) 631e9c6da27SAndrzej Hajda { 632e9c6da27SAndrzej Hajda struct sii8620_mt_msg *msg = sii8620_mt_msg_new(ctx); 633e9c6da27SAndrzej Hajda 634e9c6da27SAndrzej Hajda if (!msg) 635e9c6da27SAndrzej Hajda return; 636e9c6da27SAndrzej Hajda 637e9c6da27SAndrzej Hajda msg->reg[0] = (reg & 0x80) ? MHL_READ_XDEVCAP_REG : MHL_READ_DEVCAP_REG; 638e9c6da27SAndrzej Hajda msg->reg[1] = reg; 639e9c6da27SAndrzej Hajda msg->send = sii8620_mt_msc_cmd_send; 640e9c6da27SAndrzej Hajda msg->recv = sii8620_mt_read_devcap_reg_recv; 641e9c6da27SAndrzej Hajda } 642e9c6da27SAndrzej Hajda 643e9c6da27SAndrzej Hajda static inline void sii8620_mt_read_xdevcap_reg(struct sii8620 *ctx, u8 reg) 644e9c6da27SAndrzej Hajda { 645e9c6da27SAndrzej Hajda sii8620_mt_read_devcap_reg(ctx, reg | 0x80); 646e9c6da27SAndrzej Hajda } 647e9c6da27SAndrzej Hajda 648e19e9c69SAndrzej Hajda static void *sii8620_burst_get_tx_buf(struct sii8620 *ctx, int len) 649e19e9c69SAndrzej Hajda { 650e19e9c69SAndrzej Hajda u8 *buf = &ctx->burst.tx_buf[ctx->burst.tx_count]; 651e19e9c69SAndrzej Hajda int size = len + 2; 652e19e9c69SAndrzej Hajda 653e19e9c69SAndrzej Hajda if (ctx->burst.tx_count + size > ARRAY_SIZE(ctx->burst.tx_buf)) { 654e19e9c69SAndrzej Hajda dev_err(ctx->dev, "TX-BLK buffer exhausted\n"); 655e19e9c69SAndrzej Hajda ctx->error = -EINVAL; 656e19e9c69SAndrzej Hajda return NULL; 657e19e9c69SAndrzej Hajda } 658e19e9c69SAndrzej Hajda 659e19e9c69SAndrzej Hajda ctx->burst.tx_count += size; 660e19e9c69SAndrzej Hajda buf[1] = len; 661e19e9c69SAndrzej Hajda 662e19e9c69SAndrzej Hajda return buf + 2; 663e19e9c69SAndrzej Hajda } 664e19e9c69SAndrzej Hajda 665e19e9c69SAndrzej Hajda static u8 *sii8620_burst_get_rx_buf(struct sii8620 *ctx, int len) 666e19e9c69SAndrzej Hajda { 667e19e9c69SAndrzej Hajda u8 *buf = &ctx->burst.rx_buf[ctx->burst.rx_count]; 668e19e9c69SAndrzej Hajda int size = len + 1; 669e19e9c69SAndrzej Hajda 670e19e9c69SAndrzej Hajda if (ctx->burst.tx_count + size > ARRAY_SIZE(ctx->burst.tx_buf)) { 671e19e9c69SAndrzej Hajda dev_err(ctx->dev, "RX-BLK buffer exhausted\n"); 672e19e9c69SAndrzej Hajda ctx->error = -EINVAL; 673e19e9c69SAndrzej Hajda return NULL; 674e19e9c69SAndrzej Hajda } 675e19e9c69SAndrzej Hajda 676e19e9c69SAndrzej Hajda ctx->burst.rx_count += size; 677e19e9c69SAndrzej Hajda buf[0] = len; 678e19e9c69SAndrzej Hajda 679e19e9c69SAndrzej Hajda return buf + 1; 680e19e9c69SAndrzej Hajda } 681e19e9c69SAndrzej Hajda 682e19e9c69SAndrzej Hajda static void sii8620_burst_send(struct sii8620 *ctx) 683e19e9c69SAndrzej Hajda { 684e19e9c69SAndrzej Hajda int tx_left = ctx->burst.tx_count; 685e19e9c69SAndrzej Hajda u8 *d = ctx->burst.tx_buf; 686e19e9c69SAndrzej Hajda 687e19e9c69SAndrzej Hajda while (tx_left > 0) { 688e19e9c69SAndrzej Hajda int len = d[1] + 2; 689e19e9c69SAndrzej Hajda 690e19e9c69SAndrzej Hajda if (ctx->burst.r_count + len > ctx->burst.r_size) 691e19e9c69SAndrzej Hajda break; 692e19e9c69SAndrzej Hajda d[0] = min(ctx->burst.rx_ack, 255); 693e19e9c69SAndrzej Hajda ctx->burst.rx_ack -= d[0]; 694e19e9c69SAndrzej Hajda sii8620_write_buf(ctx, REG_EMSC_XMIT_WRITE_PORT, d, len); 695e19e9c69SAndrzej Hajda ctx->burst.r_count += len; 696e19e9c69SAndrzej Hajda tx_left -= len; 697e19e9c69SAndrzej Hajda d += len; 698e19e9c69SAndrzej Hajda } 699e19e9c69SAndrzej Hajda 700e19e9c69SAndrzej Hajda ctx->burst.tx_count = tx_left; 701e19e9c69SAndrzej Hajda 702e19e9c69SAndrzej Hajda while (ctx->burst.rx_ack > 0) { 703e19e9c69SAndrzej Hajda u8 b[2] = { min(ctx->burst.rx_ack, 255), 0 }; 704e19e9c69SAndrzej Hajda 705e19e9c69SAndrzej Hajda if (ctx->burst.r_count + 2 > ctx->burst.r_size) 706e19e9c69SAndrzej Hajda break; 707e19e9c69SAndrzej Hajda ctx->burst.rx_ack -= b[0]; 708e19e9c69SAndrzej Hajda sii8620_write_buf(ctx, REG_EMSC_XMIT_WRITE_PORT, b, 2); 709e19e9c69SAndrzej Hajda ctx->burst.r_count += 2; 710e19e9c69SAndrzej Hajda } 711e19e9c69SAndrzej Hajda } 712e19e9c69SAndrzej Hajda 713e19e9c69SAndrzej Hajda static void sii8620_burst_receive(struct sii8620 *ctx) 714e19e9c69SAndrzej Hajda { 715e19e9c69SAndrzej Hajda u8 buf[3], *d; 716e19e9c69SAndrzej Hajda int count; 717e19e9c69SAndrzej Hajda 718e19e9c69SAndrzej Hajda sii8620_read_buf(ctx, REG_EMSCRFIFOBCNTL, buf, 2); 719e19e9c69SAndrzej Hajda count = get_unaligned_le16(buf); 720e19e9c69SAndrzej Hajda while (count > 0) { 721e19e9c69SAndrzej Hajda int len = min(count, 3); 722e19e9c69SAndrzej Hajda 723e19e9c69SAndrzej Hajda sii8620_read_buf(ctx, REG_EMSC_RCV_READ_PORT, buf, len); 724e19e9c69SAndrzej Hajda count -= len; 725e19e9c69SAndrzej Hajda ctx->burst.rx_ack += len - 1; 726e19e9c69SAndrzej Hajda ctx->burst.r_count -= buf[1]; 727e19e9c69SAndrzej Hajda if (ctx->burst.r_count < 0) 728e19e9c69SAndrzej Hajda ctx->burst.r_count = 0; 729e19e9c69SAndrzej Hajda 730e19e9c69SAndrzej Hajda if (len < 3 || !buf[2]) 731e19e9c69SAndrzej Hajda continue; 732e19e9c69SAndrzej Hajda 733e19e9c69SAndrzej Hajda len = buf[2]; 734e19e9c69SAndrzej Hajda d = sii8620_burst_get_rx_buf(ctx, len); 735e19e9c69SAndrzej Hajda if (!d) 736e19e9c69SAndrzej Hajda continue; 737e19e9c69SAndrzej Hajda sii8620_read_buf(ctx, REG_EMSC_RCV_READ_PORT, d, len); 738e19e9c69SAndrzej Hajda count -= len; 739e19e9c69SAndrzej Hajda ctx->burst.rx_ack += len; 740e19e9c69SAndrzej Hajda } 741e19e9c69SAndrzej Hajda } 742e19e9c69SAndrzej Hajda 743e19e9c69SAndrzej Hajda static void sii8620_burst_tx_rbuf_info(struct sii8620 *ctx, int size) 744e19e9c69SAndrzej Hajda { 745e19e9c69SAndrzej Hajda struct mhl_burst_blk_rcv_buffer_info *d = 746e19e9c69SAndrzej Hajda sii8620_burst_get_tx_buf(ctx, sizeof(*d)); 747e19e9c69SAndrzej Hajda if (!d) 748e19e9c69SAndrzej Hajda return; 749e19e9c69SAndrzej Hajda 750e19e9c69SAndrzej Hajda d->id = cpu_to_be16(MHL_BURST_ID_BLK_RCV_BUFFER_INFO); 751e19e9c69SAndrzej Hajda d->size = cpu_to_le16(size); 752e19e9c69SAndrzej Hajda } 753e19e9c69SAndrzej Hajda 754bf1722caSAndrzej Hajda static u8 sii8620_checksum(void *ptr, int size) 755bf1722caSAndrzej Hajda { 756bf1722caSAndrzej Hajda u8 *d = ptr, sum = 0; 757bf1722caSAndrzej Hajda 758bf1722caSAndrzej Hajda while (size--) 759bf1722caSAndrzej Hajda sum += *d++; 760bf1722caSAndrzej Hajda 761bf1722caSAndrzej Hajda return sum; 762bf1722caSAndrzej Hajda } 763bf1722caSAndrzej Hajda 764bf1722caSAndrzej Hajda static void sii8620_mhl_burst_hdr_set(struct mhl3_burst_header *h, 765bf1722caSAndrzej Hajda enum mhl_burst_id id) 766bf1722caSAndrzej Hajda { 767bf1722caSAndrzej Hajda h->id = cpu_to_be16(id); 768bf1722caSAndrzej Hajda h->total_entries = 1; 769bf1722caSAndrzej Hajda h->sequence_index = 1; 770bf1722caSAndrzej Hajda } 771bf1722caSAndrzej Hajda 772bf1722caSAndrzej Hajda static void sii8620_burst_tx_bits_per_pixel_fmt(struct sii8620 *ctx, u8 fmt) 773bf1722caSAndrzej Hajda { 774bf1722caSAndrzej Hajda struct mhl_burst_bits_per_pixel_fmt *d; 775bf1722caSAndrzej Hajda const int size = sizeof(*d) + sizeof(d->desc[0]); 776bf1722caSAndrzej Hajda 777bf1722caSAndrzej Hajda d = sii8620_burst_get_tx_buf(ctx, size); 778bf1722caSAndrzej Hajda if (!d) 779bf1722caSAndrzej Hajda return; 780bf1722caSAndrzej Hajda 781bf1722caSAndrzej Hajda sii8620_mhl_burst_hdr_set(&d->hdr, MHL_BURST_ID_BITS_PER_PIXEL_FMT); 782bf1722caSAndrzej Hajda d->num_entries = 1; 783bf1722caSAndrzej Hajda d->desc[0].stream_id = 0; 784bf1722caSAndrzej Hajda d->desc[0].pixel_format = fmt; 785bf1722caSAndrzej Hajda d->hdr.checksum -= sii8620_checksum(d, size); 786bf1722caSAndrzej Hajda } 787bf1722caSAndrzej Hajda 788e19e9c69SAndrzej Hajda static void sii8620_burst_rx_all(struct sii8620 *ctx) 789e19e9c69SAndrzej Hajda { 790e19e9c69SAndrzej Hajda u8 *d = ctx->burst.rx_buf; 791e19e9c69SAndrzej Hajda int count = ctx->burst.rx_count; 792e19e9c69SAndrzej Hajda 793e19e9c69SAndrzej Hajda while (count-- > 0) { 794e19e9c69SAndrzej Hajda int len = *d++; 795e19e9c69SAndrzej Hajda int id = get_unaligned_be16(&d[0]); 796e19e9c69SAndrzej Hajda 797e19e9c69SAndrzej Hajda switch (id) { 798e19e9c69SAndrzej Hajda case MHL_BURST_ID_BLK_RCV_BUFFER_INFO: 799e19e9c69SAndrzej Hajda ctx->burst.r_size = get_unaligned_le16(&d[2]); 800e19e9c69SAndrzej Hajda break; 801e19e9c69SAndrzej Hajda default: 802e19e9c69SAndrzej Hajda break; 803e19e9c69SAndrzej Hajda } 804e19e9c69SAndrzej Hajda count -= len; 805e19e9c69SAndrzej Hajda d += len; 806e19e9c69SAndrzej Hajda } 807e19e9c69SAndrzej Hajda ctx->burst.rx_count = 0; 808e19e9c69SAndrzej Hajda } 809e19e9c69SAndrzej Hajda 810ce6e153fSAndrzej Hajda static void sii8620_fetch_edid(struct sii8620 *ctx) 811ce6e153fSAndrzej Hajda { 812ce6e153fSAndrzej Hajda u8 lm_ddc, ddc_cmd, int3, cbus; 8138e627a1bSAndrzej Hajda unsigned long timeout; 814ce6e153fSAndrzej Hajda int fetched, i; 815ce6e153fSAndrzej Hajda int edid_len = EDID_LENGTH; 816ce6e153fSAndrzej Hajda u8 *edid; 817ce6e153fSAndrzej Hajda 818ce6e153fSAndrzej Hajda sii8620_readb(ctx, REG_CBUS_STATUS); 819ce6e153fSAndrzej Hajda lm_ddc = sii8620_readb(ctx, REG_LM_DDC); 820ce6e153fSAndrzej Hajda ddc_cmd = sii8620_readb(ctx, REG_DDC_CMD); 821ce6e153fSAndrzej Hajda 822ce6e153fSAndrzej Hajda sii8620_write_seq(ctx, 823ce6e153fSAndrzej Hajda REG_INTR9_MASK, 0, 824ce6e153fSAndrzej Hajda REG_EDID_CTRL, BIT_EDID_CTRL_EDID_FIFO_ADDR_AUTO, 825ce6e153fSAndrzej Hajda REG_HDCP2X_POLL_CS, 0x71, 826ce6e153fSAndrzej Hajda REG_HDCP2X_CTRL_0, BIT_HDCP2X_CTRL_0_HDCP2X_HDCPTX, 827ce6e153fSAndrzej Hajda REG_LM_DDC, lm_ddc | BIT_LM_DDC_SW_TPI_EN_DISABLED, 828ce6e153fSAndrzej Hajda ); 829ce6e153fSAndrzej Hajda 830ce6e153fSAndrzej Hajda for (i = 0; i < 256; ++i) { 831ce6e153fSAndrzej Hajda u8 ddc_stat = sii8620_readb(ctx, REG_DDC_STATUS); 832ce6e153fSAndrzej Hajda 833ce6e153fSAndrzej Hajda if (!(ddc_stat & BIT_DDC_STATUS_DDC_I2C_IN_PROG)) 834ce6e153fSAndrzej Hajda break; 835ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_DDC_STATUS, 836ce6e153fSAndrzej Hajda BIT_DDC_STATUS_DDC_FIFO_EMPTY); 837ce6e153fSAndrzej Hajda } 838ce6e153fSAndrzej Hajda 839ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_DDC_ADDR, 0x50 << 1); 840ce6e153fSAndrzej Hajda 841ce6e153fSAndrzej Hajda edid = kmalloc(EDID_LENGTH, GFP_KERNEL); 842ce6e153fSAndrzej Hajda if (!edid) { 843ce6e153fSAndrzej Hajda ctx->error = -ENOMEM; 844ce6e153fSAndrzej Hajda return; 845ce6e153fSAndrzej Hajda } 846ce6e153fSAndrzej Hajda 847ce6e153fSAndrzej Hajda #define FETCH_SIZE 16 848ce6e153fSAndrzej Hajda for (fetched = 0; fetched < edid_len; fetched += FETCH_SIZE) { 849ce6e153fSAndrzej Hajda sii8620_readb(ctx, REG_DDC_STATUS); 850ce6e153fSAndrzej Hajda sii8620_write_seq(ctx, 851ce6e153fSAndrzej Hajda REG_DDC_CMD, ddc_cmd | VAL_DDC_CMD_DDC_CMD_ABORT, 852ce6e153fSAndrzej Hajda REG_DDC_CMD, ddc_cmd | VAL_DDC_CMD_DDC_CMD_CLEAR_FIFO, 853ce6e153fSAndrzej Hajda REG_DDC_STATUS, BIT_DDC_STATUS_DDC_FIFO_EMPTY 854ce6e153fSAndrzej Hajda ); 855ce6e153fSAndrzej Hajda sii8620_write_seq(ctx, 856ce6e153fSAndrzej Hajda REG_DDC_SEGM, fetched >> 8, 857ce6e153fSAndrzej Hajda REG_DDC_OFFSET, fetched & 0xff, 858ce6e153fSAndrzej Hajda REG_DDC_DIN_CNT1, FETCH_SIZE, 859ce6e153fSAndrzej Hajda REG_DDC_DIN_CNT2, 0, 860ce6e153fSAndrzej Hajda REG_DDC_CMD, ddc_cmd | VAL_DDC_CMD_ENH_DDC_READ_NO_ACK 861ce6e153fSAndrzej Hajda ); 862ce6e153fSAndrzej Hajda 8638e627a1bSAndrzej Hajda int3 = 0; 8648e627a1bSAndrzej Hajda timeout = jiffies + msecs_to_jiffies(200); 8658e627a1bSAndrzej Hajda for (;;) { 866ce6e153fSAndrzej Hajda cbus = sii8620_readb(ctx, REG_CBUS_STATUS); 8678e627a1bSAndrzej Hajda if (~cbus & BIT_CBUS_STATUS_CBUS_CONNECTED) { 868ce6e153fSAndrzej Hajda kfree(edid); 869ce6e153fSAndrzej Hajda edid = NULL; 870ce6e153fSAndrzej Hajda goto end; 871ce6e153fSAndrzej Hajda } 8728e627a1bSAndrzej Hajda if (int3 & BIT_DDC_CMD_DONE) { 8738e627a1bSAndrzej Hajda if (sii8620_readb(ctx, REG_DDC_DOUT_CNT) 8748e627a1bSAndrzej Hajda >= FETCH_SIZE) 8758e627a1bSAndrzej Hajda break; 8768e627a1bSAndrzej Hajda } else { 8778e627a1bSAndrzej Hajda int3 = sii8620_readb(ctx, REG_INTR3); 8788e627a1bSAndrzej Hajda } 8798e627a1bSAndrzej Hajda if (time_is_before_jiffies(timeout)) { 8808e627a1bSAndrzej Hajda ctx->error = -ETIMEDOUT; 8818e627a1bSAndrzej Hajda dev_err(ctx->dev, "timeout during EDID read\n"); 8828e627a1bSAndrzej Hajda kfree(edid); 8838e627a1bSAndrzej Hajda edid = NULL; 8848e627a1bSAndrzej Hajda goto end; 8858e627a1bSAndrzej Hajda } 886ce6e153fSAndrzej Hajda usleep_range(10, 20); 8878e627a1bSAndrzej Hajda } 888ce6e153fSAndrzej Hajda 889ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_DDC_DATA, edid + fetched, FETCH_SIZE); 890ce6e153fSAndrzej Hajda if (fetched + FETCH_SIZE == EDID_LENGTH) { 891ce6e153fSAndrzej Hajda u8 ext = ((struct edid *)edid)->extensions; 892ce6e153fSAndrzej Hajda 893ce6e153fSAndrzej Hajda if (ext) { 894ce6e153fSAndrzej Hajda u8 *new_edid; 895ce6e153fSAndrzej Hajda 896ce6e153fSAndrzej Hajda edid_len += ext * EDID_LENGTH; 897ce6e153fSAndrzej Hajda new_edid = krealloc(edid, edid_len, GFP_KERNEL); 898ce6e153fSAndrzej Hajda if (!new_edid) { 899ce6e153fSAndrzej Hajda kfree(edid); 900ce6e153fSAndrzej Hajda ctx->error = -ENOMEM; 901ce6e153fSAndrzej Hajda return; 902ce6e153fSAndrzej Hajda } 903ce6e153fSAndrzej Hajda edid = new_edid; 904ce6e153fSAndrzej Hajda } 905ce6e153fSAndrzej Hajda } 906ce6e153fSAndrzej Hajda } 907ce6e153fSAndrzej Hajda 908263b5c93SAndrzej Hajda sii8620_write_seq(ctx, 909263b5c93SAndrzej Hajda REG_INTR3_MASK, BIT_DDC_CMD_DONE, 910263b5c93SAndrzej Hajda REG_LM_DDC, lm_ddc 911263b5c93SAndrzej Hajda ); 912ce6e153fSAndrzej Hajda 913ce6e153fSAndrzej Hajda end: 914ce6e153fSAndrzej Hajda kfree(ctx->edid); 915ce6e153fSAndrzej Hajda ctx->edid = (struct edid *)edid; 916ce6e153fSAndrzej Hajda } 917ce6e153fSAndrzej Hajda 918ce6e153fSAndrzej Hajda static void sii8620_set_upstream_edid(struct sii8620 *ctx) 919ce6e153fSAndrzej Hajda { 920ce6e153fSAndrzej Hajda sii8620_setbits(ctx, REG_DPD, BIT_DPD_PDNRX12 | BIT_DPD_PDIDCK_N 921ce6e153fSAndrzej Hajda | BIT_DPD_PD_MHL_CLK_N, 0xff); 922ce6e153fSAndrzej Hajda 923ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 924ce6e153fSAndrzej Hajda REG_RX_HDMI_CTRL3, 0x00, 925ce6e153fSAndrzej Hajda REG_PKT_FILTER_0, 0xFF, 926ce6e153fSAndrzej Hajda REG_PKT_FILTER_1, 0xFF, 927ce6e153fSAndrzej Hajda REG_ALICE0_BW_I2C, 0x06 928ce6e153fSAndrzej Hajda ); 929ce6e153fSAndrzej Hajda 930ce6e153fSAndrzej Hajda sii8620_setbits(ctx, REG_RX_HDMI_CLR_BUFFER, 931ce6e153fSAndrzej Hajda BIT_RX_HDMI_CLR_BUFFER_VSI_CLR_EN, 0xff); 932ce6e153fSAndrzej Hajda 933ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 934ce6e153fSAndrzej Hajda REG_EDID_CTRL, BIT_EDID_CTRL_EDID_FIFO_ADDR_AUTO 935ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_MODE_EN, 936ce6e153fSAndrzej Hajda REG_EDID_FIFO_ADDR, 0, 937ce6e153fSAndrzej Hajda ); 938ce6e153fSAndrzej Hajda 939ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, REG_EDID_FIFO_WR_DATA, (u8 *)ctx->edid, 940ce6e153fSAndrzej Hajda (ctx->edid->extensions + 1) * EDID_LENGTH); 941ce6e153fSAndrzej Hajda 942ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 943ce6e153fSAndrzej Hajda REG_EDID_CTRL, BIT_EDID_CTRL_EDID_PRIME_VALID 944ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_FIFO_ADDR_AUTO 945ce6e153fSAndrzej Hajda | BIT_EDID_CTRL_EDID_MODE_EN, 946ce6e153fSAndrzej Hajda REG_INTR5_MASK, BIT_INTR_SCDT_CHANGE, 947ce6e153fSAndrzej Hajda REG_INTR9_MASK, 0 948ce6e153fSAndrzej Hajda ); 949ce6e153fSAndrzej Hajda } 950ce6e153fSAndrzej Hajda 951ce6e153fSAndrzej Hajda static void sii8620_xtal_set_rate(struct sii8620 *ctx) 952ce6e153fSAndrzej Hajda { 953ce6e153fSAndrzej Hajda static const struct { 954ce6e153fSAndrzej Hajda unsigned int rate; 955ce6e153fSAndrzej Hajda u8 div; 956ce6e153fSAndrzej Hajda u8 tp1; 957ce6e153fSAndrzej Hajda } rates[] = { 958ce6e153fSAndrzej Hajda { 19200, 0x04, 0x53 }, 959ce6e153fSAndrzej Hajda { 20000, 0x04, 0x62 }, 960ce6e153fSAndrzej Hajda { 24000, 0x05, 0x75 }, 961ce6e153fSAndrzej Hajda { 30000, 0x06, 0x92 }, 962ce6e153fSAndrzej Hajda { 38400, 0x0c, 0xbc }, 963ce6e153fSAndrzej Hajda }; 964ce6e153fSAndrzej Hajda unsigned long rate = clk_get_rate(ctx->clk_xtal) / 1000; 965ce6e153fSAndrzej Hajda int i; 966ce6e153fSAndrzej Hajda 967ce6e153fSAndrzej Hajda for (i = 0; i < ARRAY_SIZE(rates) - 1; ++i) 968ce6e153fSAndrzej Hajda if (rate <= rates[i].rate) 969ce6e153fSAndrzej Hajda break; 970ce6e153fSAndrzej Hajda 971ce6e153fSAndrzej Hajda if (rate != rates[i].rate) 972ce6e153fSAndrzej Hajda dev_err(ctx->dev, "xtal clock rate(%lukHz) not supported, setting MHL for %ukHz.\n", 973ce6e153fSAndrzej Hajda rate, rates[i].rate); 974ce6e153fSAndrzej Hajda 975ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_DIV_CTL_MAIN, rates[i].div); 976ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_HDCP2X_TP1, rates[i].tp1); 977ce6e153fSAndrzej Hajda } 978ce6e153fSAndrzej Hajda 979ce6e153fSAndrzej Hajda static int sii8620_hw_on(struct sii8620 *ctx) 980ce6e153fSAndrzej Hajda { 981ce6e153fSAndrzej Hajda int ret; 982ce6e153fSAndrzej Hajda 983ce6e153fSAndrzej Hajda ret = regulator_bulk_enable(ARRAY_SIZE(ctx->supplies), ctx->supplies); 984ce6e153fSAndrzej Hajda if (ret) 985ce6e153fSAndrzej Hajda return ret; 9868efaac07SAndrzej Hajda 987ce6e153fSAndrzej Hajda usleep_range(10000, 20000); 9888efaac07SAndrzej Hajda ret = clk_prepare_enable(ctx->clk_xtal); 9898efaac07SAndrzej Hajda if (ret) 9908efaac07SAndrzej Hajda return ret; 9918efaac07SAndrzej Hajda 9928efaac07SAndrzej Hajda msleep(100); 9938efaac07SAndrzej Hajda gpiod_set_value(ctx->gpio_reset, 0); 9948efaac07SAndrzej Hajda msleep(100); 9958efaac07SAndrzej Hajda 9968efaac07SAndrzej Hajda return 0; 997ce6e153fSAndrzej Hajda } 998ce6e153fSAndrzej Hajda 999ce6e153fSAndrzej Hajda static int sii8620_hw_off(struct sii8620 *ctx) 1000ce6e153fSAndrzej Hajda { 1001ce6e153fSAndrzej Hajda clk_disable_unprepare(ctx->clk_xtal); 1002ce6e153fSAndrzej Hajda gpiod_set_value(ctx->gpio_reset, 1); 1003ce6e153fSAndrzej Hajda return regulator_bulk_disable(ARRAY_SIZE(ctx->supplies), ctx->supplies); 1004ce6e153fSAndrzej Hajda } 1005ce6e153fSAndrzej Hajda 1006ce6e153fSAndrzej Hajda static void sii8620_cbus_reset(struct sii8620 *ctx) 1007ce6e153fSAndrzej Hajda { 10084dc3c071SAndrzej Hajda sii8620_write(ctx, REG_PWD_SRST, BIT_PWD_SRST_CBUS_RST 10094dc3c071SAndrzej Hajda | BIT_PWD_SRST_CBUS_RST_SW_EN); 10104dc3c071SAndrzej Hajda usleep_range(10000, 20000); 10114dc3c071SAndrzej Hajda sii8620_write(ctx, REG_PWD_SRST, BIT_PWD_SRST_CBUS_RST_SW_EN); 1012ce6e153fSAndrzej Hajda } 1013ce6e153fSAndrzej Hajda 1014ce6e153fSAndrzej Hajda static void sii8620_set_auto_zone(struct sii8620 *ctx) 1015ce6e153fSAndrzej Hajda { 1016ce6e153fSAndrzej Hajda if (ctx->mode != CM_MHL1) { 1017ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1018ce6e153fSAndrzej Hajda REG_TX_ZONE_CTL1, 0x0, 1019ce6e153fSAndrzej Hajda REG_MHL_PLL_CTL0, VAL_MHL_PLL_CTL0_HDMI_CLK_RATIO_1X 1020ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_CRYSTAL_CLK_SEL 1021ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_ZONE_MASK_OE 1022ce6e153fSAndrzej Hajda ); 1023ce6e153fSAndrzej Hajda } else { 1024ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1025ce6e153fSAndrzej Hajda REG_TX_ZONE_CTL1, VAL_TX_ZONE_CTL1_TX_ZONE_CTRL_MODE, 1026ce6e153fSAndrzej Hajda REG_MHL_PLL_CTL0, VAL_MHL_PLL_CTL0_HDMI_CLK_RATIO_1X 1027ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_ZONE_MASK_OE 1028ce6e153fSAndrzej Hajda ); 1029ce6e153fSAndrzej Hajda } 1030ce6e153fSAndrzej Hajda } 1031ce6e153fSAndrzej Hajda 1032ce6e153fSAndrzej Hajda static void sii8620_stop_video(struct sii8620 *ctx) 1033ce6e153fSAndrzej Hajda { 1034ce6e153fSAndrzej Hajda u8 uninitialized_var(val); 1035ce6e153fSAndrzej Hajda 1036ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1037ce6e153fSAndrzej Hajda REG_TPI_INTR_EN, 0, 1038ce6e153fSAndrzej Hajda REG_HDCP2X_INTR0_MASK, 0, 1039ce6e153fSAndrzej Hajda REG_TPI_COPP_DATA2, 0, 1040ce6e153fSAndrzej Hajda REG_TPI_INTR_ST0, ~0, 1041ce6e153fSAndrzej Hajda ); 1042ce6e153fSAndrzej Hajda 1043ce6e153fSAndrzej Hajda switch (ctx->sink_type) { 1044ce6e153fSAndrzej Hajda case SINK_DVI: 1045ce6e153fSAndrzej Hajda val = BIT_TPI_SC_REG_TMDS_OE_POWER_DOWN 1046ce6e153fSAndrzej Hajda | BIT_TPI_SC_TPI_AV_MUTE; 1047ce6e153fSAndrzej Hajda break; 1048ce6e153fSAndrzej Hajda case SINK_HDMI: 1049ef822a07SAndrzej Hajda default: 1050ce6e153fSAndrzej Hajda val = BIT_TPI_SC_REG_TMDS_OE_POWER_DOWN 1051ce6e153fSAndrzej Hajda | BIT_TPI_SC_TPI_AV_MUTE 1052ce6e153fSAndrzej Hajda | BIT_TPI_SC_TPI_OUTPUT_MODE_0_HDMI; 1053ce6e153fSAndrzej Hajda break; 1054ce6e153fSAndrzej Hajda } 1055ce6e153fSAndrzej Hajda 1056ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_TPI_SC, val); 1057ce6e153fSAndrzej Hajda } 1058ce6e153fSAndrzej Hajda 1059bf1722caSAndrzej Hajda static void sii8620_set_format(struct sii8620 *ctx) 1060bf1722caSAndrzej Hajda { 1061bf1722caSAndrzej Hajda u8 out_fmt; 1062bf1722caSAndrzej Hajda 1063bf1722caSAndrzej Hajda if (sii8620_is_mhl3(ctx)) { 1064bf1722caSAndrzej Hajda sii8620_setbits(ctx, REG_M3_P0CTRL, 1065bf1722caSAndrzej Hajda BIT_M3_P0CTRL_MHL3_P0_PIXEL_MODE_PACKED, 1066bf1722caSAndrzej Hajda ctx->use_packed_pixel ? ~0 : 0); 1067bf1722caSAndrzej Hajda } else { 1068bf1722caSAndrzej Hajda if (ctx->use_packed_pixel) 1069bf1722caSAndrzej Hajda sii8620_write_seq_static(ctx, 1070bf1722caSAndrzej Hajda REG_VID_MODE, BIT_VID_MODE_M1080P, 1071bf1722caSAndrzej Hajda REG_MHL_TOP_CTL, BIT_MHL_TOP_CTL_MHL_PP_SEL | 1, 1072bf1722caSAndrzej Hajda REG_MHLTX_CTL6, 0x60 1073bf1722caSAndrzej Hajda ); 1074bf1722caSAndrzej Hajda else 1075bf1722caSAndrzej Hajda sii8620_write_seq_static(ctx, 1076bf1722caSAndrzej Hajda REG_VID_MODE, 0, 1077bf1722caSAndrzej Hajda REG_MHL_TOP_CTL, 1, 1078bf1722caSAndrzej Hajda REG_MHLTX_CTL6, 0xa0 1079bf1722caSAndrzej Hajda ); 1080bf1722caSAndrzej Hajda } 1081bf1722caSAndrzej Hajda 1082bf1722caSAndrzej Hajda if (ctx->use_packed_pixel) 1083bf1722caSAndrzej Hajda out_fmt = VAL_TPI_FORMAT(YCBCR422, FULL) | 1084bf1722caSAndrzej Hajda BIT_TPI_OUTPUT_CSCMODE709; 1085bf1722caSAndrzej Hajda else 1086bf1722caSAndrzej Hajda out_fmt = VAL_TPI_FORMAT(RGB, FULL); 1087bf1722caSAndrzej Hajda 1088bf1722caSAndrzej Hajda sii8620_write_seq(ctx, 1089bf1722caSAndrzej Hajda REG_TPI_INPUT, VAL_TPI_FORMAT(RGB, FULL), 1090bf1722caSAndrzej Hajda REG_TPI_OUTPUT, out_fmt, 1091bf1722caSAndrzej Hajda ); 1092bf1722caSAndrzej Hajda } 1093bf1722caSAndrzej Hajda 1094bf1722caSAndrzej Hajda static int mhl3_infoframe_init(struct mhl3_infoframe *frame) 1095bf1722caSAndrzej Hajda { 1096bf1722caSAndrzej Hajda memset(frame, 0, sizeof(*frame)); 1097bf1722caSAndrzej Hajda 1098bf1722caSAndrzej Hajda frame->version = 3; 1099bf1722caSAndrzej Hajda frame->hev_format = -1; 1100bf1722caSAndrzej Hajda return 0; 1101bf1722caSAndrzej Hajda } 1102bf1722caSAndrzej Hajda 1103bf1722caSAndrzej Hajda static ssize_t mhl3_infoframe_pack(struct mhl3_infoframe *frame, 1104bf1722caSAndrzej Hajda void *buffer, size_t size) 1105bf1722caSAndrzej Hajda { 1106bf1722caSAndrzej Hajda const int frm_len = HDMI_INFOFRAME_HEADER_SIZE + MHL3_INFOFRAME_SIZE; 1107bf1722caSAndrzej Hajda u8 *ptr = buffer; 1108bf1722caSAndrzej Hajda 1109bf1722caSAndrzej Hajda if (size < frm_len) 1110bf1722caSAndrzej Hajda return -ENOSPC; 1111bf1722caSAndrzej Hajda 1112bf1722caSAndrzej Hajda memset(buffer, 0, size); 1113bf1722caSAndrzej Hajda ptr[0] = HDMI_INFOFRAME_TYPE_VENDOR; 1114bf1722caSAndrzej Hajda ptr[1] = frame->version; 1115bf1722caSAndrzej Hajda ptr[2] = MHL3_INFOFRAME_SIZE; 1116bf1722caSAndrzej Hajda ptr[4] = MHL3_IEEE_OUI & 0xff; 1117bf1722caSAndrzej Hajda ptr[5] = (MHL3_IEEE_OUI >> 8) & 0xff; 1118bf1722caSAndrzej Hajda ptr[6] = (MHL3_IEEE_OUI >> 16) & 0xff; 1119bf1722caSAndrzej Hajda ptr[7] = frame->video_format & 0x3; 1120bf1722caSAndrzej Hajda ptr[7] |= (frame->format_type & 0x7) << 2; 1121bf1722caSAndrzej Hajda ptr[7] |= frame->sep_audio ? BIT(5) : 0; 1122bf1722caSAndrzej Hajda if (frame->hev_format >= 0) { 1123bf1722caSAndrzej Hajda ptr[9] = 1; 1124bf1722caSAndrzej Hajda ptr[10] = (frame->hev_format >> 8) & 0xff; 1125bf1722caSAndrzej Hajda ptr[11] = frame->hev_format & 0xff; 1126bf1722caSAndrzej Hajda } 1127bf1722caSAndrzej Hajda if (frame->av_delay) { 1128bf1722caSAndrzej Hajda bool sign = frame->av_delay < 0; 1129bf1722caSAndrzej Hajda int delay = sign ? -frame->av_delay : frame->av_delay; 1130bf1722caSAndrzej Hajda 1131bf1722caSAndrzej Hajda ptr[12] = (delay >> 16) & 0xf; 1132bf1722caSAndrzej Hajda if (sign) 1133bf1722caSAndrzej Hajda ptr[12] |= BIT(4); 1134bf1722caSAndrzej Hajda ptr[13] = (delay >> 8) & 0xff; 1135bf1722caSAndrzej Hajda ptr[14] = delay & 0xff; 1136bf1722caSAndrzej Hajda } 1137bf1722caSAndrzej Hajda ptr[3] -= sii8620_checksum(buffer, frm_len); 1138bf1722caSAndrzej Hajda return frm_len; 1139bf1722caSAndrzej Hajda } 1140bf1722caSAndrzej Hajda 1141bf1722caSAndrzej Hajda static void sii8620_set_infoframes(struct sii8620 *ctx) 1142bf1722caSAndrzej Hajda { 1143bf1722caSAndrzej Hajda struct mhl3_infoframe mhl_frm; 1144bf1722caSAndrzej Hajda union hdmi_infoframe frm; 1145bf1722caSAndrzej Hajda u8 buf[31]; 1146bf1722caSAndrzej Hajda int ret; 1147bf1722caSAndrzej Hajda 1148bf1722caSAndrzej Hajda if (!sii8620_is_mhl3(ctx) || !ctx->use_packed_pixel) { 1149bf1722caSAndrzej Hajda sii8620_write(ctx, REG_TPI_SC, 1150bf1722caSAndrzej Hajda BIT_TPI_SC_TPI_OUTPUT_MODE_0_HDMI); 1151bf1722caSAndrzej Hajda sii8620_write_buf(ctx, REG_TPI_AVI_CHSUM, ctx->avif + 3, 1152bf1722caSAndrzej Hajda ARRAY_SIZE(ctx->avif) - 3); 1153bf1722caSAndrzej Hajda sii8620_write(ctx, REG_PKT_FILTER_0, 1154bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_CEA_GAMUT_PKT | 1155bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_MPEG_PKT | 1156bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_GCP_PKT, 1157bf1722caSAndrzej Hajda BIT_PKT_FILTER_1_DROP_GEN_PKT); 1158bf1722caSAndrzej Hajda return; 1159bf1722caSAndrzej Hajda } 1160bf1722caSAndrzej Hajda 1161bf1722caSAndrzej Hajda ret = hdmi_avi_infoframe_init(&frm.avi); 1162bf1722caSAndrzej Hajda frm.avi.colorspace = HDMI_COLORSPACE_YUV422; 1163bf1722caSAndrzej Hajda frm.avi.active_aspect = HDMI_ACTIVE_ASPECT_PICTURE; 1164bf1722caSAndrzej Hajda frm.avi.picture_aspect = HDMI_PICTURE_ASPECT_16_9; 1165bf1722caSAndrzej Hajda frm.avi.colorimetry = HDMI_COLORIMETRY_ITU_709; 1166bf1722caSAndrzej Hajda frm.avi.video_code = ctx->video_code; 1167bf1722caSAndrzej Hajda if (!ret) 1168bf1722caSAndrzej Hajda ret = hdmi_avi_infoframe_pack(&frm.avi, buf, ARRAY_SIZE(buf)); 1169bf1722caSAndrzej Hajda if (ret > 0) 1170bf1722caSAndrzej Hajda sii8620_write_buf(ctx, REG_TPI_AVI_CHSUM, buf + 3, ret - 3); 1171bf1722caSAndrzej Hajda sii8620_write(ctx, REG_PKT_FILTER_0, 1172bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_CEA_GAMUT_PKT | 1173bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_MPEG_PKT | 1174bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_AVI_PKT | 1175bf1722caSAndrzej Hajda BIT_PKT_FILTER_0_DROP_GCP_PKT, 1176bf1722caSAndrzej Hajda BIT_PKT_FILTER_1_VSI_OVERRIDE_DIS | 1177bf1722caSAndrzej Hajda BIT_PKT_FILTER_1_DROP_GEN_PKT | 1178bf1722caSAndrzej Hajda BIT_PKT_FILTER_1_DROP_VSIF_PKT); 1179bf1722caSAndrzej Hajda 1180bf1722caSAndrzej Hajda sii8620_write(ctx, REG_TPI_INFO_FSEL, BIT_TPI_INFO_FSEL_EN 1181bf1722caSAndrzej Hajda | BIT_TPI_INFO_FSEL_RPT | VAL_TPI_INFO_FSEL_VSI); 1182bf1722caSAndrzej Hajda ret = mhl3_infoframe_init(&mhl_frm); 1183bf1722caSAndrzej Hajda if (!ret) 1184bf1722caSAndrzej Hajda ret = mhl3_infoframe_pack(&mhl_frm, buf, ARRAY_SIZE(buf)); 1185bf1722caSAndrzej Hajda sii8620_write_buf(ctx, REG_TPI_INFO_B0, buf, ret); 1186bf1722caSAndrzej Hajda } 1187bf1722caSAndrzej Hajda 11885c632e22SMaciej Purski static void sii8620_start_video(struct sii8620 *ctx) 1189ce6e153fSAndrzej Hajda { 11905c632e22SMaciej Purski if (!sii8620_is_mhl3(ctx)) 11915c632e22SMaciej Purski sii8620_stop_video(ctx); 11925c632e22SMaciej Purski 11935c632e22SMaciej Purski if (ctx->sink_type == SINK_DVI && !sii8620_is_mhl3(ctx)) { 11945c632e22SMaciej Purski sii8620_write(ctx, REG_RX_HDMI_CTRL2, 11955c632e22SMaciej Purski VAL_RX_HDMI_CTRL2_DEFVAL); 11965c632e22SMaciej Purski sii8620_write(ctx, REG_TPI_SC, 0); 11975c632e22SMaciej Purski return; 11985c632e22SMaciej Purski } 11995c632e22SMaciej Purski 1200ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1201ce6e153fSAndrzej Hajda REG_RX_HDMI_CTRL2, VAL_RX_HDMI_CTRL2_DEFVAL 1202ce6e153fSAndrzej Hajda | BIT_RX_HDMI_CTRL2_USE_AV_MUTE, 1203ce6e153fSAndrzej Hajda REG_VID_OVRRD, BIT_VID_OVRRD_PP_AUTO_DISABLE 1204bf1722caSAndrzej Hajda | BIT_VID_OVRRD_M1080P_OVRRD); 1205bf1722caSAndrzej Hajda sii8620_set_format(ctx); 1206ce6e153fSAndrzej Hajda 1207bf1722caSAndrzej Hajda if (!sii8620_is_mhl3(ctx)) { 1208ce6e153fSAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_DST_REG(LINK_MODE), 1209bf1722caSAndrzej Hajda MHL_DST_LM_CLK_MODE_NORMAL | MHL_DST_LM_PATH_ENABLED); 1210ce6e153fSAndrzej Hajda sii8620_set_auto_zone(ctx); 1211bf1722caSAndrzej Hajda } else { 1212bf1722caSAndrzej Hajda static const struct { 1213bf1722caSAndrzej Hajda int max_clk; 1214bf1722caSAndrzej Hajda u8 zone; 1215bf1722caSAndrzej Hajda u8 link_rate; 1216bf1722caSAndrzej Hajda u8 rrp_decode; 1217bf1722caSAndrzej Hajda } clk_spec[] = { 1218bf1722caSAndrzej Hajda { 150000, VAL_TX_ZONE_CTL3_TX_ZONE_1_5GBPS, 1219bf1722caSAndrzej Hajda MHL_XDS_LINK_RATE_1_5_GBPS, 0x38 }, 1220bf1722caSAndrzej Hajda { 300000, VAL_TX_ZONE_CTL3_TX_ZONE_3GBPS, 1221bf1722caSAndrzej Hajda MHL_XDS_LINK_RATE_3_0_GBPS, 0x40 }, 1222bf1722caSAndrzej Hajda { 600000, VAL_TX_ZONE_CTL3_TX_ZONE_6GBPS, 1223bf1722caSAndrzej Hajda MHL_XDS_LINK_RATE_6_0_GBPS, 0x40 }, 1224bf1722caSAndrzej Hajda }; 1225bf1722caSAndrzej Hajda u8 p0_ctrl = BIT_M3_P0CTRL_MHL3_P0_PORT_EN; 1226bf1722caSAndrzej Hajda int clk = ctx->pixel_clock * (ctx->use_packed_pixel ? 2 : 3); 1227bf1722caSAndrzej Hajda int i; 1228ce6e153fSAndrzej Hajda 12299378cecbSMaciej Purski for (i = 0; i < ARRAY_SIZE(clk_spec) - 1; ++i) 1230bf1722caSAndrzej Hajda if (clk < clk_spec[i].max_clk) 1231bf1722caSAndrzej Hajda break; 1232ce6e153fSAndrzej Hajda 1233bf1722caSAndrzej Hajda if (100 * clk >= 98 * clk_spec[i].max_clk) 1234bf1722caSAndrzej Hajda p0_ctrl |= BIT_M3_P0CTRL_MHL3_P0_UNLIMIT_EN; 1235ce6e153fSAndrzej Hajda 1236bf1722caSAndrzej Hajda sii8620_burst_tx_bits_per_pixel_fmt(ctx, ctx->use_packed_pixel); 1237bf1722caSAndrzej Hajda sii8620_burst_send(ctx); 1238bf1722caSAndrzej Hajda sii8620_write_seq(ctx, 1239bf1722caSAndrzej Hajda REG_MHL_DP_CTL0, 0xf0, 1240bf1722caSAndrzej Hajda REG_MHL3_TX_ZONE_CTL, clk_spec[i].zone); 1241bf1722caSAndrzej Hajda sii8620_setbits(ctx, REG_M3_P0CTRL, 1242bf1722caSAndrzej Hajda BIT_M3_P0CTRL_MHL3_P0_PORT_EN 1243bf1722caSAndrzej Hajda | BIT_M3_P0CTRL_MHL3_P0_UNLIMIT_EN, p0_ctrl); 1244bf1722caSAndrzej Hajda sii8620_setbits(ctx, REG_M3_POSTM, MSK_M3_POSTM_RRP_DECODE, 1245bf1722caSAndrzej Hajda clk_spec[i].rrp_decode); 1246bf1722caSAndrzej Hajda sii8620_write_seq_static(ctx, 1247bf1722caSAndrzej Hajda REG_M3_CTRL, VAL_M3_CTRL_MHL3_VALUE 1248bf1722caSAndrzej Hajda | BIT_M3_CTRL_H2M_SWRST, 1249bf1722caSAndrzej Hajda REG_M3_CTRL, VAL_M3_CTRL_MHL3_VALUE 1250bf1722caSAndrzej Hajda ); 1251bf1722caSAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_XDS_REG(AVLINK_MODE_CONTROL), 1252bf1722caSAndrzej Hajda clk_spec[i].link_rate); 1253bf1722caSAndrzej Hajda } 1254bf1722caSAndrzej Hajda 1255bf1722caSAndrzej Hajda sii8620_set_infoframes(ctx); 1256ce6e153fSAndrzej Hajda } 1257ce6e153fSAndrzej Hajda 1258ce6e153fSAndrzej Hajda static void sii8620_disable_hpd(struct sii8620 *ctx) 1259ce6e153fSAndrzej Hajda { 1260ce6e153fSAndrzej Hajda sii8620_setbits(ctx, REG_EDID_CTRL, BIT_EDID_CTRL_EDID_PRIME_VALID, 0); 1261ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1262ce6e153fSAndrzej Hajda REG_HPD_CTRL, BIT_HPD_CTRL_HPD_OUT_OVR_EN, 1263ce6e153fSAndrzej Hajda REG_INTR8_MASK, 0 1264ce6e153fSAndrzej Hajda ); 1265ce6e153fSAndrzej Hajda } 1266ce6e153fSAndrzej Hajda 1267ce6e153fSAndrzej Hajda static void sii8620_enable_hpd(struct sii8620 *ctx) 1268ce6e153fSAndrzej Hajda { 1269ce6e153fSAndrzej Hajda sii8620_setbits(ctx, REG_TMDS_CSTAT_P3, 1270ce6e153fSAndrzej Hajda BIT_TMDS_CSTAT_P3_SCDT_CLR_AVI_DIS 1271ce6e153fSAndrzej Hajda | BIT_TMDS_CSTAT_P3_CLR_AVI, ~0); 1272ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1273ce6e153fSAndrzej Hajda REG_HPD_CTRL, BIT_HPD_CTRL_HPD_OUT_OVR_EN 1274ce6e153fSAndrzej Hajda | BIT_HPD_CTRL_HPD_HIGH, 1275ce6e153fSAndrzej Hajda ); 1276ce6e153fSAndrzej Hajda } 1277ce6e153fSAndrzej Hajda 1278ce6e153fSAndrzej Hajda static void sii8620_mhl_discover(struct sii8620 *ctx) 1279ce6e153fSAndrzej Hajda { 1280ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1281ce6e153fSAndrzej Hajda REG_DISC_CTRL9, BIT_DISC_CTRL9_WAKE_DRVFLT 1282ce6e153fSAndrzej Hajda | BIT_DISC_CTRL9_DISC_PULSE_PROCEED, 1283ce6e153fSAndrzej Hajda REG_DISC_CTRL4, VAL_DISC_CTRL4(VAL_PUP_5K, VAL_PUP_20K), 1284ce6e153fSAndrzej Hajda REG_CBUS_DISC_INTR0_MASK, BIT_MHL3_EST_INT 1285ce6e153fSAndrzej Hajda | BIT_MHL_EST_INT 1286ce6e153fSAndrzej Hajda | BIT_NOT_MHL_EST_INT 1287ce6e153fSAndrzej Hajda | BIT_CBUS_MHL3_DISCON_INT 1288ce6e153fSAndrzej Hajda | BIT_CBUS_MHL12_DISCON_INT 1289ce6e153fSAndrzej Hajda | BIT_RGND_READY_INT, 1290ce6e153fSAndrzej Hajda REG_MHL_PLL_CTL0, VAL_MHL_PLL_CTL0_HDMI_CLK_RATIO_1X 1291ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_CRYSTAL_CLK_SEL 1292ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_ZONE_MASK_OE, 1293ce6e153fSAndrzej Hajda REG_MHL_DP_CTL0, BIT_MHL_DP_CTL0_DP_OE 1294ce6e153fSAndrzej Hajda | BIT_MHL_DP_CTL0_TX_OE_OVR, 1295ce6e153fSAndrzej Hajda REG_M3_CTRL, VAL_M3_CTRL_MHL3_VALUE, 1296ce6e153fSAndrzej Hajda REG_MHL_DP_CTL1, 0xA2, 1297ce6e153fSAndrzej Hajda REG_MHL_DP_CTL2, 0x03, 1298ce6e153fSAndrzej Hajda REG_MHL_DP_CTL3, 0x35, 1299ce6e153fSAndrzej Hajda REG_MHL_DP_CTL5, 0x02, 1300ce6e153fSAndrzej Hajda REG_MHL_DP_CTL6, 0x02, 1301ce6e153fSAndrzej Hajda REG_MHL_DP_CTL7, 0x03, 1302ce6e153fSAndrzej Hajda REG_COC_CTLC, 0xFF, 1303ce6e153fSAndrzej Hajda REG_DPD, BIT_DPD_PWRON_PLL | BIT_DPD_PDNTX12 1304ce6e153fSAndrzej Hajda | BIT_DPD_OSC_EN | BIT_DPD_PWRON_HSIC, 1305ce6e153fSAndrzej Hajda REG_COC_INTR_MASK, BIT_COC_PLL_LOCK_STATUS_CHANGE 1306ce6e153fSAndrzej Hajda | BIT_COC_CALIBRATION_DONE, 1307ce6e153fSAndrzej Hajda REG_CBUS_INT_1_MASK, BIT_CBUS_MSC_ABORT_RCVD 1308ce6e153fSAndrzej Hajda | BIT_CBUS_CMD_ABORT, 1309ce6e153fSAndrzej Hajda REG_CBUS_INT_0_MASK, BIT_CBUS_MSC_MT_DONE 1310ce6e153fSAndrzej Hajda | BIT_CBUS_HPD_CHG 1311ce6e153fSAndrzej Hajda | BIT_CBUS_MSC_MR_WRITE_STAT 1312ce6e153fSAndrzej Hajda | BIT_CBUS_MSC_MR_MSC_MSG 1313ce6e153fSAndrzej Hajda | BIT_CBUS_MSC_MR_WRITE_BURST 1314ce6e153fSAndrzej Hajda | BIT_CBUS_MSC_MR_SET_INT 1315ce6e153fSAndrzej Hajda | BIT_CBUS_MSC_MT_DONE_NACK 1316ce6e153fSAndrzej Hajda ); 1317ce6e153fSAndrzej Hajda } 1318ce6e153fSAndrzej Hajda 1319ce6e153fSAndrzej Hajda static void sii8620_peer_specific_init(struct sii8620 *ctx) 1320ce6e153fSAndrzej Hajda { 1321bb4954c7SAndrzej Hajda if (sii8620_is_mhl3(ctx)) 1322ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1323ce6e153fSAndrzej Hajda REG_SYS_CTRL1, BIT_SYS_CTRL1_BLOCK_DDC_BY_HPD, 1324ce6e153fSAndrzej Hajda REG_EMSCINTRMASK1, 1325ce6e153fSAndrzej Hajda BIT_EMSCINTR1_EMSC_TRAINING_COMMA_ERR 1326ce6e153fSAndrzej Hajda ); 1327ce6e153fSAndrzej Hajda else 1328ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1329ce6e153fSAndrzej Hajda REG_HDCP2X_INTR0_MASK, 0x00, 1330ce6e153fSAndrzej Hajda REG_EMSCINTRMASK1, 0x00, 1331ce6e153fSAndrzej Hajda REG_HDCP2X_INTR0, 0xFF, 1332ce6e153fSAndrzej Hajda REG_INTR1, 0xFF, 1333ce6e153fSAndrzej Hajda REG_SYS_CTRL1, BIT_SYS_CTRL1_BLOCK_DDC_BY_HPD 1334ce6e153fSAndrzej Hajda | BIT_SYS_CTRL1_TX_CTRL_HDMI 1335ce6e153fSAndrzej Hajda ); 1336ce6e153fSAndrzej Hajda } 1337ce6e153fSAndrzej Hajda 1338ce6e153fSAndrzej Hajda #define SII8620_MHL_VERSION 0x32 1339ce6e153fSAndrzej Hajda #define SII8620_SCRATCHPAD_SIZE 16 1340ce6e153fSAndrzej Hajda #define SII8620_INT_STAT_SIZE 0x33 1341ce6e153fSAndrzej Hajda 1342ce6e153fSAndrzej Hajda static void sii8620_set_dev_cap(struct sii8620 *ctx) 1343ce6e153fSAndrzej Hajda { 1344ce6e153fSAndrzej Hajda static const u8 devcap[MHL_DCAP_SIZE] = { 1345ce6e153fSAndrzej Hajda [MHL_DCAP_MHL_VERSION] = SII8620_MHL_VERSION, 1346ce6e153fSAndrzej Hajda [MHL_DCAP_CAT] = MHL_DCAP_CAT_SOURCE | MHL_DCAP_CAT_POWER, 1347ce6e153fSAndrzej Hajda [MHL_DCAP_ADOPTER_ID_H] = 0x01, 1348ce6e153fSAndrzej Hajda [MHL_DCAP_ADOPTER_ID_L] = 0x41, 1349ce6e153fSAndrzej Hajda [MHL_DCAP_VID_LINK_MODE] = MHL_DCAP_VID_LINK_RGB444 1350ce6e153fSAndrzej Hajda | MHL_DCAP_VID_LINK_PPIXEL 1351ce6e153fSAndrzej Hajda | MHL_DCAP_VID_LINK_16BPP, 1352ce6e153fSAndrzej Hajda [MHL_DCAP_AUD_LINK_MODE] = MHL_DCAP_AUD_LINK_2CH, 1353ce6e153fSAndrzej Hajda [MHL_DCAP_VIDEO_TYPE] = MHL_DCAP_VT_GRAPHICS, 1354ce6e153fSAndrzej Hajda [MHL_DCAP_LOG_DEV_MAP] = MHL_DCAP_LD_GUI, 1355ce6e153fSAndrzej Hajda [MHL_DCAP_BANDWIDTH] = 0x0f, 1356ce6e153fSAndrzej Hajda [MHL_DCAP_FEATURE_FLAG] = MHL_DCAP_FEATURE_RCP_SUPPORT 1357ce6e153fSAndrzej Hajda | MHL_DCAP_FEATURE_RAP_SUPPORT 1358ce6e153fSAndrzej Hajda | MHL_DCAP_FEATURE_SP_SUPPORT, 1359ce6e153fSAndrzej Hajda [MHL_DCAP_SCRATCHPAD_SIZE] = SII8620_SCRATCHPAD_SIZE, 1360ce6e153fSAndrzej Hajda [MHL_DCAP_INT_STAT_SIZE] = SII8620_INT_STAT_SIZE, 1361ce6e153fSAndrzej Hajda }; 1362ce6e153fSAndrzej Hajda static const u8 xdcap[MHL_XDC_SIZE] = { 1363ce6e153fSAndrzej Hajda [MHL_XDC_ECBUS_SPEEDS] = MHL_XDC_ECBUS_S_075 1364ce6e153fSAndrzej Hajda | MHL_XDC_ECBUS_S_8BIT, 1365ce6e153fSAndrzej Hajda [MHL_XDC_TMDS_SPEEDS] = MHL_XDC_TMDS_150 1366ce6e153fSAndrzej Hajda | MHL_XDC_TMDS_300 | MHL_XDC_TMDS_600, 1367ce6e153fSAndrzej Hajda [MHL_XDC_ECBUS_ROLES] = MHL_XDC_DEV_HOST, 1368ce6e153fSAndrzej Hajda [MHL_XDC_LOG_DEV_MAPX] = MHL_XDC_LD_PHONE, 1369ce6e153fSAndrzej Hajda }; 1370ce6e153fSAndrzej Hajda 1371ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, REG_MHL_DEVCAP_0, devcap, ARRAY_SIZE(devcap)); 1372ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, REG_MHL_EXTDEVCAP_0, xdcap, ARRAY_SIZE(xdcap)); 1373ce6e153fSAndrzej Hajda } 1374ce6e153fSAndrzej Hajda 1375ce6e153fSAndrzej Hajda static void sii8620_mhl_init(struct sii8620 *ctx) 1376ce6e153fSAndrzej Hajda { 1377ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1378ce6e153fSAndrzej Hajda REG_DISC_CTRL4, VAL_DISC_CTRL4(VAL_PUP_OFF, VAL_PUP_20K), 1379ce6e153fSAndrzej Hajda REG_CBUS_MSC_COMPAT_CTRL, 1380ce6e153fSAndrzej Hajda BIT_CBUS_MSC_COMPAT_CTRL_XDEVCAP_EN, 1381ce6e153fSAndrzej Hajda ); 1382ce6e153fSAndrzej Hajda 1383ce6e153fSAndrzej Hajda sii8620_peer_specific_init(ctx); 1384ce6e153fSAndrzej Hajda 1385ce6e153fSAndrzej Hajda sii8620_disable_hpd(ctx); 1386ce6e153fSAndrzej Hajda 1387ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1388ce6e153fSAndrzej Hajda REG_EDID_CTRL, BIT_EDID_CTRL_EDID_FIFO_ADDR_AUTO, 1389ce6e153fSAndrzej Hajda REG_DISC_CTRL9, BIT_DISC_CTRL9_WAKE_DRVFLT 1390ce6e153fSAndrzej Hajda | BIT_DISC_CTRL9_WAKE_PULSE_BYPASS, 1391ce6e153fSAndrzej Hajda REG_TMDS0_CCTRL1, 0x90, 1392ce6e153fSAndrzej Hajda REG_TMDS_CLK_EN, 0x01, 1393ce6e153fSAndrzej Hajda REG_TMDS_CH_EN, 0x11, 1394ce6e153fSAndrzej Hajda REG_BGR_BIAS, 0x87, 1395ce6e153fSAndrzej Hajda REG_ALICE0_ZONE_CTRL, 0xE8, 1396ce6e153fSAndrzej Hajda REG_ALICE0_MODE_CTRL, 0x04, 1397ce6e153fSAndrzej Hajda ); 1398ce6e153fSAndrzej Hajda sii8620_setbits(ctx, REG_LM_DDC, BIT_LM_DDC_SW_TPI_EN_DISABLED, 0); 1399ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1400ce6e153fSAndrzej Hajda REG_TPI_HW_OPT3, 0x76, 1401ce6e153fSAndrzej Hajda REG_TMDS_CCTRL, BIT_TMDS_CCTRL_TMDS_OE, 1402ce6e153fSAndrzej Hajda REG_TPI_DTD_B2, 79, 1403ce6e153fSAndrzej Hajda ); 1404ce6e153fSAndrzej Hajda sii8620_set_dev_cap(ctx); 1405ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1406ce6e153fSAndrzej Hajda REG_MDT_XMIT_TIMEOUT, 100, 1407ce6e153fSAndrzej Hajda REG_MDT_XMIT_CTRL, 0x03, 1408ce6e153fSAndrzej Hajda REG_MDT_XFIFO_STAT, 0x00, 1409ce6e153fSAndrzej Hajda REG_MDT_RCV_TIMEOUT, 100, 1410ce6e153fSAndrzej Hajda REG_CBUS_LINK_CTRL_8, 0x1D, 1411ce6e153fSAndrzej Hajda ); 1412ce6e153fSAndrzej Hajda 1413ce6e153fSAndrzej Hajda sii8620_start_gen2_write_burst(ctx); 1414ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1415ce6e153fSAndrzej Hajda REG_BIST_CTRL, 0x00, 1416ce6e153fSAndrzej Hajda REG_COC_CTL1, 0x10, 1417ce6e153fSAndrzej Hajda REG_COC_CTL2, 0x18, 1418ce6e153fSAndrzej Hajda REG_COC_CTLF, 0x07, 1419ce6e153fSAndrzej Hajda REG_COC_CTL11, 0xF8, 1420ce6e153fSAndrzej Hajda REG_COC_CTL17, 0x61, 1421ce6e153fSAndrzej Hajda REG_COC_CTL18, 0x46, 1422ce6e153fSAndrzej Hajda REG_COC_CTL19, 0x15, 1423ce6e153fSAndrzej Hajda REG_COC_CTL1A, 0x01, 1424ce6e153fSAndrzej Hajda REG_MHL_COC_CTL3, BIT_MHL_COC_CTL3_COC_AECHO_EN, 1425ce6e153fSAndrzej Hajda REG_MHL_COC_CTL4, 0x2D, 1426ce6e153fSAndrzej Hajda REG_MHL_COC_CTL5, 0xF9, 1427ce6e153fSAndrzej Hajda REG_MSC_HEARTBEAT_CTRL, 0x27, 1428ce6e153fSAndrzej Hajda ); 1429ce6e153fSAndrzej Hajda sii8620_disable_gen2_write_burst(ctx); 1430ce6e153fSAndrzej Hajda 14319fc6ade8SAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_DST_REG(VERSION), SII8620_MHL_VERSION); 1432ce6e153fSAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_DST_REG(CONNECTED_RDY), 1433ce6e153fSAndrzej Hajda MHL_DST_CONN_DCAP_RDY | MHL_DST_CONN_XDEVCAPP_SUPP 1434ce6e153fSAndrzej Hajda | MHL_DST_CONN_POW_STAT); 1435ce6e153fSAndrzej Hajda sii8620_mt_set_int(ctx, MHL_INT_REG(RCHANGE), MHL_INT_RC_DCAP_CHG); 1436ce6e153fSAndrzej Hajda } 1437ce6e153fSAndrzej Hajda 14382c8fb853SAndrzej Hajda static void sii8620_emsc_enable(struct sii8620 *ctx) 14392c8fb853SAndrzej Hajda { 14402c8fb853SAndrzej Hajda u8 reg; 14412c8fb853SAndrzej Hajda 14422c8fb853SAndrzej Hajda sii8620_setbits(ctx, REG_GENCTL, BIT_GENCTL_EMSC_EN 14432c8fb853SAndrzej Hajda | BIT_GENCTL_CLR_EMSC_RFIFO 14442c8fb853SAndrzej Hajda | BIT_GENCTL_CLR_EMSC_XFIFO, ~0); 14452c8fb853SAndrzej Hajda sii8620_setbits(ctx, REG_GENCTL, BIT_GENCTL_CLR_EMSC_RFIFO 14462c8fb853SAndrzej Hajda | BIT_GENCTL_CLR_EMSC_XFIFO, 0); 14472c8fb853SAndrzej Hajda sii8620_setbits(ctx, REG_COMMECNT, BIT_COMMECNT_I2C_TO_EMSC_EN, ~0); 14482c8fb853SAndrzej Hajda reg = sii8620_readb(ctx, REG_EMSCINTR); 14492c8fb853SAndrzej Hajda sii8620_write(ctx, REG_EMSCINTR, reg); 14502c8fb853SAndrzej Hajda sii8620_write(ctx, REG_EMSCINTRMASK, BIT_EMSCINTR_SPI_DVLD); 14512c8fb853SAndrzej Hajda } 14522c8fb853SAndrzej Hajda 14532c8fb853SAndrzej Hajda static int sii8620_wait_for_fsm_state(struct sii8620 *ctx, u8 state) 14542c8fb853SAndrzej Hajda { 14552c8fb853SAndrzej Hajda int i; 14562c8fb853SAndrzej Hajda 14572c8fb853SAndrzej Hajda for (i = 0; i < 10; ++i) { 14582c8fb853SAndrzej Hajda u8 s = sii8620_readb(ctx, REG_COC_STAT_0); 14592c8fb853SAndrzej Hajda 14602c8fb853SAndrzej Hajda if ((s & MSK_COC_STAT_0_FSM_STATE) == state) 14612c8fb853SAndrzej Hajda return 0; 14622c8fb853SAndrzej Hajda if (!(s & BIT_COC_STAT_0_PLL_LOCKED)) 14632c8fb853SAndrzej Hajda return -EBUSY; 14642c8fb853SAndrzej Hajda usleep_range(4000, 6000); 14652c8fb853SAndrzej Hajda } 14662c8fb853SAndrzej Hajda return -ETIMEDOUT; 14672c8fb853SAndrzej Hajda } 14682c8fb853SAndrzej Hajda 1469ce6e153fSAndrzej Hajda static void sii8620_set_mode(struct sii8620 *ctx, enum sii8620_mode mode) 1470ce6e153fSAndrzej Hajda { 14712c8fb853SAndrzej Hajda int ret; 14722c8fb853SAndrzej Hajda 1473ce6e153fSAndrzej Hajda if (ctx->mode == mode) 1474ce6e153fSAndrzej Hajda return; 1475ce6e153fSAndrzej Hajda 1476ce6e153fSAndrzej Hajda switch (mode) { 1477ce6e153fSAndrzej Hajda case CM_MHL1: 1478ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1479ce6e153fSAndrzej Hajda REG_CBUS_MSC_COMPAT_CTRL, 0x02, 1480ce6e153fSAndrzej Hajda REG_M3_CTRL, VAL_M3_CTRL_MHL1_2_VALUE, 1481ce6e153fSAndrzej Hajda REG_DPD, BIT_DPD_PWRON_PLL | BIT_DPD_PDNTX12 1482ce6e153fSAndrzej Hajda | BIT_DPD_OSC_EN, 1483ce6e153fSAndrzej Hajda REG_COC_INTR_MASK, 0 1484ce6e153fSAndrzej Hajda ); 14852c8fb853SAndrzej Hajda ctx->mode = mode; 1486ce6e153fSAndrzej Hajda break; 1487ce6e153fSAndrzej Hajda case CM_MHL3: 1488dd123129SAndrzej Hajda sii8620_write(ctx, REG_M3_CTRL, VAL_M3_CTRL_MHL3_VALUE); 14892c8fb853SAndrzej Hajda ctx->mode = mode; 14902c8fb853SAndrzej Hajda return; 14912c8fb853SAndrzej Hajda case CM_ECBUS_S: 14922c8fb853SAndrzej Hajda sii8620_emsc_enable(ctx); 14932c8fb853SAndrzej Hajda sii8620_write_seq_static(ctx, 14942c8fb853SAndrzej Hajda REG_TTXSPINUMS, 4, 14952c8fb853SAndrzej Hajda REG_TRXSPINUMS, 4, 14962c8fb853SAndrzej Hajda REG_TTXHSICNUMS, 0x14, 14972c8fb853SAndrzej Hajda REG_TRXHSICNUMS, 0x14, 14982c8fb853SAndrzej Hajda REG_TTXTOTNUMS, 0x18, 14992c8fb853SAndrzej Hajda REG_TRXTOTNUMS, 0x18, 15002c8fb853SAndrzej Hajda REG_PWD_SRST, BIT_PWD_SRST_COC_DOC_RST 15012c8fb853SAndrzej Hajda | BIT_PWD_SRST_CBUS_RST_SW_EN, 15022c8fb853SAndrzej Hajda REG_MHL_COC_CTL1, 0xbd, 15032c8fb853SAndrzej Hajda REG_PWD_SRST, BIT_PWD_SRST_CBUS_RST_SW_EN, 15042c8fb853SAndrzej Hajda REG_COC_CTLB, 0x01, 15052c8fb853SAndrzej Hajda REG_COC_CTL0, 0x5c, 15062c8fb853SAndrzej Hajda REG_COC_CTL14, 0x03, 15072c8fb853SAndrzej Hajda REG_COC_CTL15, 0x80, 15082c8fb853SAndrzej Hajda REG_MHL_DP_CTL6, BIT_MHL_DP_CTL6_DP_TAP1_SGN 15092c8fb853SAndrzej Hajda | BIT_MHL_DP_CTL6_DP_TAP1_EN 15102c8fb853SAndrzej Hajda | BIT_MHL_DP_CTL6_DT_PREDRV_FEEDCAP_EN, 15112c8fb853SAndrzej Hajda REG_MHL_DP_CTL8, 0x03 15122c8fb853SAndrzej Hajda ); 15132c8fb853SAndrzej Hajda ret = sii8620_wait_for_fsm_state(ctx, 0x03); 15142c8fb853SAndrzej Hajda sii8620_write_seq_static(ctx, 15152c8fb853SAndrzej Hajda REG_COC_CTL14, 0x00, 15162c8fb853SAndrzej Hajda REG_COC_CTL15, 0x80 15172c8fb853SAndrzej Hajda ); 15182c8fb853SAndrzej Hajda if (!ret) 15192c8fb853SAndrzej Hajda sii8620_write(ctx, REG_CBUS3_CNVT, 0x85); 15202c8fb853SAndrzej Hajda else 15212c8fb853SAndrzej Hajda sii8620_disconnect(ctx); 1522dd123129SAndrzej Hajda return; 1523ce6e153fSAndrzej Hajda case CM_DISCONNECTED: 15242c8fb853SAndrzej Hajda ctx->mode = mode; 1525ce6e153fSAndrzej Hajda break; 1526ce6e153fSAndrzej Hajda default: 1527ce6e153fSAndrzej Hajda dev_err(ctx->dev, "%s mode %d not supported\n", __func__, mode); 1528ce6e153fSAndrzej Hajda break; 15293a81e960Skbuild test robot } 1530ce6e153fSAndrzej Hajda 1531ce6e153fSAndrzej Hajda sii8620_set_auto_zone(ctx); 1532ce6e153fSAndrzej Hajda 1533ce6e153fSAndrzej Hajda if (mode != CM_MHL1) 1534ce6e153fSAndrzej Hajda return; 1535ce6e153fSAndrzej Hajda 1536ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1537ce6e153fSAndrzej Hajda REG_MHL_DP_CTL0, 0xBC, 1538ce6e153fSAndrzej Hajda REG_MHL_DP_CTL1, 0xBB, 1539ce6e153fSAndrzej Hajda REG_MHL_DP_CTL3, 0x48, 1540ce6e153fSAndrzej Hajda REG_MHL_DP_CTL5, 0x39, 1541ce6e153fSAndrzej Hajda REG_MHL_DP_CTL2, 0x2A, 1542ce6e153fSAndrzej Hajda REG_MHL_DP_CTL6, 0x2A, 1543ce6e153fSAndrzej Hajda REG_MHL_DP_CTL7, 0x08 1544ce6e153fSAndrzej Hajda ); 1545ce6e153fSAndrzej Hajda } 1546ce6e153fSAndrzej Hajda 1547ce6e153fSAndrzej Hajda static void sii8620_disconnect(struct sii8620 *ctx) 1548ce6e153fSAndrzej Hajda { 1549ce6e153fSAndrzej Hajda sii8620_disable_gen2_write_burst(ctx); 1550ce6e153fSAndrzej Hajda sii8620_stop_video(ctx); 1551003f9929SAndrzej Hajda msleep(100); 1552ce6e153fSAndrzej Hajda sii8620_cbus_reset(ctx); 1553ce6e153fSAndrzej Hajda sii8620_set_mode(ctx, CM_DISCONNECTED); 1554ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1555003f9929SAndrzej Hajda REG_TX_ZONE_CTL1, 0, 1556003f9929SAndrzej Hajda REG_MHL_PLL_CTL0, 0x07, 1557ce6e153fSAndrzej Hajda REG_COC_CTL0, 0x40, 1558ce6e153fSAndrzej Hajda REG_CBUS3_CNVT, 0x84, 1559ce6e153fSAndrzej Hajda REG_COC_CTL14, 0x00, 1560ce6e153fSAndrzej Hajda REG_COC_CTL0, 0x40, 1561ce6e153fSAndrzej Hajda REG_HRXCTRL3, 0x07, 1562ce6e153fSAndrzej Hajda REG_MHL_PLL_CTL0, VAL_MHL_PLL_CTL0_HDMI_CLK_RATIO_1X 1563ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_CRYSTAL_CLK_SEL 1564ce6e153fSAndrzej Hajda | BIT_MHL_PLL_CTL0_ZONE_MASK_OE, 1565ce6e153fSAndrzej Hajda REG_MHL_DP_CTL0, BIT_MHL_DP_CTL0_DP_OE 1566ce6e153fSAndrzej Hajda | BIT_MHL_DP_CTL0_TX_OE_OVR, 1567ce6e153fSAndrzej Hajda REG_MHL_DP_CTL1, 0xBB, 1568ce6e153fSAndrzej Hajda REG_MHL_DP_CTL3, 0x48, 1569ce6e153fSAndrzej Hajda REG_MHL_DP_CTL5, 0x3F, 1570ce6e153fSAndrzej Hajda REG_MHL_DP_CTL2, 0x2F, 1571ce6e153fSAndrzej Hajda REG_MHL_DP_CTL6, 0x2A, 1572ce6e153fSAndrzej Hajda REG_MHL_DP_CTL7, 0x03 1573ce6e153fSAndrzej Hajda ); 1574ce6e153fSAndrzej Hajda sii8620_disable_hpd(ctx); 1575ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1576ce6e153fSAndrzej Hajda REG_M3_CTRL, VAL_M3_CTRL_MHL3_VALUE, 1577ce6e153fSAndrzej Hajda REG_MHL_COC_CTL1, 0x07, 1578ce6e153fSAndrzej Hajda REG_DISC_CTRL4, VAL_DISC_CTRL4(VAL_PUP_OFF, VAL_PUP_20K), 1579ce6e153fSAndrzej Hajda REG_DISC_CTRL8, 0x00, 1580ce6e153fSAndrzej Hajda REG_DISC_CTRL9, BIT_DISC_CTRL9_WAKE_DRVFLT 1581ce6e153fSAndrzej Hajda | BIT_DISC_CTRL9_WAKE_PULSE_BYPASS, 1582ce6e153fSAndrzej Hajda REG_INT_CTRL, 0x00, 1583ce6e153fSAndrzej Hajda REG_MSC_HEARTBEAT_CTRL, 0x27, 1584ce6e153fSAndrzej Hajda REG_DISC_CTRL1, 0x25, 1585ce6e153fSAndrzej Hajda REG_CBUS_DISC_INTR0, (u8)~BIT_RGND_READY_INT, 1586ce6e153fSAndrzej Hajda REG_CBUS_DISC_INTR0_MASK, BIT_RGND_READY_INT, 1587ce6e153fSAndrzej Hajda REG_MDT_INT_1, 0xff, 1588ce6e153fSAndrzej Hajda REG_MDT_INT_1_MASK, 0x00, 1589ce6e153fSAndrzej Hajda REG_MDT_INT_0, 0xff, 1590ce6e153fSAndrzej Hajda REG_MDT_INT_0_MASK, 0x00, 1591ce6e153fSAndrzej Hajda REG_COC_INTR, 0xff, 1592ce6e153fSAndrzej Hajda REG_COC_INTR_MASK, 0x00, 1593ce6e153fSAndrzej Hajda REG_TRXINTH, 0xff, 1594ce6e153fSAndrzej Hajda REG_TRXINTMH, 0x00, 1595ce6e153fSAndrzej Hajda REG_CBUS_INT_0, 0xff, 1596ce6e153fSAndrzej Hajda REG_CBUS_INT_0_MASK, 0x00, 1597ce6e153fSAndrzej Hajda REG_CBUS_INT_1, 0xff, 1598ce6e153fSAndrzej Hajda REG_CBUS_INT_1_MASK, 0x00, 1599ce6e153fSAndrzej Hajda REG_EMSCINTR, 0xff, 1600ce6e153fSAndrzej Hajda REG_EMSCINTRMASK, 0x00, 1601ce6e153fSAndrzej Hajda REG_EMSCINTR1, 0xff, 1602ce6e153fSAndrzej Hajda REG_EMSCINTRMASK1, 0x00, 1603ce6e153fSAndrzej Hajda REG_INTR8, 0xff, 1604ce6e153fSAndrzej Hajda REG_INTR8_MASK, 0x00, 1605ce6e153fSAndrzej Hajda REG_TPI_INTR_ST0, 0xff, 1606ce6e153fSAndrzej Hajda REG_TPI_INTR_EN, 0x00, 1607ce6e153fSAndrzej Hajda REG_HDCP2X_INTR0, 0xff, 1608ce6e153fSAndrzej Hajda REG_HDCP2X_INTR0_MASK, 0x00, 1609ce6e153fSAndrzej Hajda REG_INTR9, 0xff, 1610ce6e153fSAndrzej Hajda REG_INTR9_MASK, 0x00, 1611ce6e153fSAndrzej Hajda REG_INTR3, 0xff, 1612ce6e153fSAndrzej Hajda REG_INTR3_MASK, 0x00, 1613ce6e153fSAndrzej Hajda REG_INTR5, 0xff, 1614ce6e153fSAndrzej Hajda REG_INTR5_MASK, 0x00, 1615ce6e153fSAndrzej Hajda REG_INTR2, 0xff, 1616ce6e153fSAndrzej Hajda REG_INTR2_MASK, 0x00, 1617ce6e153fSAndrzej Hajda ); 1618ce6e153fSAndrzej Hajda memset(ctx->stat, 0, sizeof(ctx->stat)); 1619ce6e153fSAndrzej Hajda memset(ctx->xstat, 0, sizeof(ctx->xstat)); 1620ce6e153fSAndrzej Hajda memset(ctx->devcap, 0, sizeof(ctx->devcap)); 1621ce6e153fSAndrzej Hajda memset(ctx->xdevcap, 0, sizeof(ctx->xdevcap)); 1622ce6e153fSAndrzej Hajda ctx->cbus_status = 0; 1623ce6e153fSAndrzej Hajda ctx->sink_type = SINK_NONE; 1624ce6e153fSAndrzej Hajda kfree(ctx->edid); 1625ce6e153fSAndrzej Hajda ctx->edid = NULL; 1626ce6e153fSAndrzej Hajda sii8620_mt_cleanup(ctx); 1627ce6e153fSAndrzej Hajda } 1628ce6e153fSAndrzej Hajda 1629ce6e153fSAndrzej Hajda static void sii8620_mhl_disconnected(struct sii8620 *ctx) 1630ce6e153fSAndrzej Hajda { 1631ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1632ce6e153fSAndrzej Hajda REG_DISC_CTRL4, VAL_DISC_CTRL4(VAL_PUP_OFF, VAL_PUP_20K), 1633ce6e153fSAndrzej Hajda REG_CBUS_MSC_COMPAT_CTRL, 1634ce6e153fSAndrzej Hajda BIT_CBUS_MSC_COMPAT_CTRL_XDEVCAP_EN 1635ce6e153fSAndrzej Hajda ); 1636ce6e153fSAndrzej Hajda sii8620_disconnect(ctx); 1637ce6e153fSAndrzej Hajda } 1638ce6e153fSAndrzej Hajda 1639ce6e153fSAndrzej Hajda static void sii8620_irq_disc(struct sii8620 *ctx) 1640ce6e153fSAndrzej Hajda { 1641ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_CBUS_DISC_INTR0); 1642ce6e153fSAndrzej Hajda 1643ce6e153fSAndrzej Hajda if (stat & VAL_CBUS_MHL_DISCON) 1644ce6e153fSAndrzej Hajda sii8620_mhl_disconnected(ctx); 1645ce6e153fSAndrzej Hajda 1646ce6e153fSAndrzej Hajda if (stat & BIT_RGND_READY_INT) { 1647ce6e153fSAndrzej Hajda u8 stat2 = sii8620_readb(ctx, REG_DISC_STAT2); 1648ce6e153fSAndrzej Hajda 1649ce6e153fSAndrzej Hajda if ((stat2 & MSK_DISC_STAT2_RGND) == VAL_RGND_1K) { 1650ce6e153fSAndrzej Hajda sii8620_mhl_discover(ctx); 1651ce6e153fSAndrzej Hajda } else { 1652ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1653ce6e153fSAndrzej Hajda REG_DISC_CTRL9, BIT_DISC_CTRL9_WAKE_DRVFLT 1654ce6e153fSAndrzej Hajda | BIT_DISC_CTRL9_NOMHL_EST 1655ce6e153fSAndrzej Hajda | BIT_DISC_CTRL9_WAKE_PULSE_BYPASS, 1656ce6e153fSAndrzej Hajda REG_CBUS_DISC_INTR0_MASK, BIT_RGND_READY_INT 1657ce6e153fSAndrzej Hajda | BIT_CBUS_MHL3_DISCON_INT 1658ce6e153fSAndrzej Hajda | BIT_CBUS_MHL12_DISCON_INT 1659ce6e153fSAndrzej Hajda | BIT_NOT_MHL_EST_INT 1660ce6e153fSAndrzej Hajda ); 1661ce6e153fSAndrzej Hajda } 1662ce6e153fSAndrzej Hajda } 1663ce6e153fSAndrzej Hajda if (stat & BIT_MHL_EST_INT) 1664ce6e153fSAndrzej Hajda sii8620_mhl_init(ctx); 1665ce6e153fSAndrzej Hajda 1666ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_CBUS_DISC_INTR0, stat); 1667ce6e153fSAndrzej Hajda } 1668ce6e153fSAndrzej Hajda 1669581a9237SAndrzej Hajda static void sii8620_read_burst(struct sii8620 *ctx) 1670581a9237SAndrzej Hajda { 1671581a9237SAndrzej Hajda u8 buf[17]; 1672581a9237SAndrzej Hajda 1673581a9237SAndrzej Hajda sii8620_read_buf(ctx, REG_MDT_RCV_READ_PORT, buf, ARRAY_SIZE(buf)); 1674581a9237SAndrzej Hajda sii8620_write(ctx, REG_MDT_RCV_CTRL, BIT_MDT_RCV_CTRL_MDT_RCV_EN | 1675581a9237SAndrzej Hajda BIT_MDT_RCV_CTRL_MDT_DELAY_RCV_EN | 1676581a9237SAndrzej Hajda BIT_MDT_RCV_CTRL_MDT_RFIFO_CLR_CUR); 1677581a9237SAndrzej Hajda sii8620_readb(ctx, REG_MDT_RFIFO_STAT); 1678581a9237SAndrzej Hajda } 1679581a9237SAndrzej Hajda 1680ce6e153fSAndrzej Hajda static void sii8620_irq_g2wb(struct sii8620 *ctx) 1681ce6e153fSAndrzej Hajda { 1682ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_MDT_INT_0); 1683ce6e153fSAndrzej Hajda 1684ce6e153fSAndrzej Hajda if (stat & BIT_MDT_IDLE_AFTER_HAWB_DISABLE) 1685581a9237SAndrzej Hajda if (sii8620_is_mhl3(ctx)) 1686581a9237SAndrzej Hajda sii8620_mt_set_int(ctx, MHL_INT_REG(RCHANGE), 1687581a9237SAndrzej Hajda MHL_INT_RC_FEAT_COMPLETE); 1688581a9237SAndrzej Hajda 1689581a9237SAndrzej Hajda if (stat & BIT_MDT_RFIFO_DATA_RDY) 1690581a9237SAndrzej Hajda sii8620_read_burst(ctx); 1691581a9237SAndrzej Hajda 1692581a9237SAndrzej Hajda if (stat & BIT_MDT_XFIFO_EMPTY) 1693581a9237SAndrzej Hajda sii8620_write(ctx, REG_MDT_XMIT_CTRL, 0); 1694ce6e153fSAndrzej Hajda 1695ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_MDT_INT_0, stat); 1696ce6e153fSAndrzej Hajda } 1697ce6e153fSAndrzej Hajda 16989fc6ade8SAndrzej Hajda static void sii8620_status_dcap_ready(struct sii8620 *ctx) 1699ce6e153fSAndrzej Hajda { 17009fc6ade8SAndrzej Hajda enum sii8620_mode mode; 17019fc6ade8SAndrzej Hajda 17029fc6ade8SAndrzej Hajda mode = ctx->stat[MHL_DST_VERSION] >= 0x30 ? CM_MHL3 : CM_MHL1; 17039fc6ade8SAndrzej Hajda if (mode > ctx->mode) 17049fc6ade8SAndrzej Hajda sii8620_set_mode(ctx, mode); 1705ce6e153fSAndrzej Hajda sii8620_peer_specific_init(ctx); 1706ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_INTR9_MASK, BIT_INTR9_DEVCAP_DONE 1707ce6e153fSAndrzej Hajda | BIT_INTR9_EDID_DONE | BIT_INTR9_EDID_ERROR); 1708ce6e153fSAndrzej Hajda } 1709ce6e153fSAndrzej Hajda 1710ce6e153fSAndrzej Hajda static void sii8620_status_changed_path(struct sii8620 *ctx) 1711ce6e153fSAndrzej Hajda { 1712ce6e153fSAndrzej Hajda if (ctx->stat[MHL_DST_LINK_MODE] & MHL_DST_LM_PATH_ENABLED) { 1713ce6e153fSAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_DST_REG(LINK_MODE), 1714ce6e153fSAndrzej Hajda MHL_DST_LM_CLK_MODE_NORMAL 1715ce6e153fSAndrzej Hajda | MHL_DST_LM_PATH_ENABLED); 1716e3a65487SAndrzej Hajda if (!sii8620_is_mhl3(ctx)) 1717ce6e153fSAndrzej Hajda sii8620_mt_read_devcap(ctx, false); 17189a466cd1SAndrzej Hajda sii8620_mt_set_cont(ctx, sii8620_sink_detected); 1719ce6e153fSAndrzej Hajda } else { 1720ce6e153fSAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_DST_REG(LINK_MODE), 1721ce6e153fSAndrzej Hajda MHL_DST_LM_CLK_MODE_NORMAL); 1722ce6e153fSAndrzej Hajda } 1723ce6e153fSAndrzej Hajda } 1724ce6e153fSAndrzej Hajda 1725ce6e153fSAndrzej Hajda static void sii8620_msc_mr_write_stat(struct sii8620 *ctx) 1726ce6e153fSAndrzej Hajda { 1727ce6e153fSAndrzej Hajda u8 st[MHL_DST_SIZE], xst[MHL_XDS_SIZE]; 1728ce6e153fSAndrzej Hajda 1729ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_MHL_STAT_0, st, MHL_DST_SIZE); 1730ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_MHL_EXTSTAT_0, xst, MHL_XDS_SIZE); 1731ce6e153fSAndrzej Hajda 1732ce6e153fSAndrzej Hajda sii8620_update_array(ctx->stat, st, MHL_DST_SIZE); 1733ce6e153fSAndrzej Hajda sii8620_update_array(ctx->xstat, xst, MHL_XDS_SIZE); 1734ce6e153fSAndrzej Hajda 17359fc6ade8SAndrzej Hajda if (ctx->stat[MHL_DST_CONNECTED_RDY] & MHL_DST_CONN_DCAP_RDY) 17369fc6ade8SAndrzej Hajda sii8620_status_dcap_ready(ctx); 1737ce6e153fSAndrzej Hajda 1738ce6e153fSAndrzej Hajda if (st[MHL_DST_LINK_MODE] & MHL_DST_LM_PATH_ENABLED) 1739ce6e153fSAndrzej Hajda sii8620_status_changed_path(ctx); 1740ce6e153fSAndrzej Hajda } 1741ce6e153fSAndrzej Hajda 17422c8fb853SAndrzej Hajda static void sii8620_ecbus_up(struct sii8620 *ctx, int ret) 17432c8fb853SAndrzej Hajda { 17442c8fb853SAndrzej Hajda if (ret < 0) 17452c8fb853SAndrzej Hajda return; 17462c8fb853SAndrzej Hajda 17472c8fb853SAndrzej Hajda sii8620_set_mode(ctx, CM_ECBUS_S); 17482c8fb853SAndrzej Hajda } 17492c8fb853SAndrzej Hajda 17502c8fb853SAndrzej Hajda static void sii8620_got_ecbus_speed(struct sii8620 *ctx, int ret) 17512c8fb853SAndrzej Hajda { 17522c8fb853SAndrzej Hajda if (ret < 0) 17532c8fb853SAndrzej Hajda return; 17542c8fb853SAndrzej Hajda 17552c8fb853SAndrzej Hajda sii8620_mt_write_stat(ctx, MHL_XDS_REG(CURR_ECBUS_MODE), 17562c8fb853SAndrzej Hajda MHL_XDS_ECBUS_S | MHL_XDS_SLOT_MODE_8BIT); 17572c8fb853SAndrzej Hajda sii8620_mt_rap(ctx, MHL_RAP_CBUS_MODE_UP); 17582c8fb853SAndrzej Hajda sii8620_mt_set_cont(ctx, sii8620_ecbus_up); 17592c8fb853SAndrzej Hajda } 17602c8fb853SAndrzej Hajda 1761269ed8eeSAndrzej Hajda static void sii8620_mhl_burst_emsc_support_set(struct mhl_burst_emsc_support *d, 1762269ed8eeSAndrzej Hajda enum mhl_burst_id id) 1763269ed8eeSAndrzej Hajda { 1764269ed8eeSAndrzej Hajda sii8620_mhl_burst_hdr_set(&d->hdr, MHL_BURST_ID_EMSC_SUPPORT); 1765269ed8eeSAndrzej Hajda d->num_entries = 1; 1766269ed8eeSAndrzej Hajda d->burst_id[0] = cpu_to_be16(id); 1767269ed8eeSAndrzej Hajda } 1768269ed8eeSAndrzej Hajda 1769269ed8eeSAndrzej Hajda static void sii8620_send_features(struct sii8620 *ctx) 1770269ed8eeSAndrzej Hajda { 1771269ed8eeSAndrzej Hajda u8 buf[16]; 1772269ed8eeSAndrzej Hajda 1773269ed8eeSAndrzej Hajda sii8620_write(ctx, REG_MDT_XMIT_CTRL, BIT_MDT_XMIT_CTRL_EN 1774269ed8eeSAndrzej Hajda | BIT_MDT_XMIT_CTRL_FIXED_BURST_LEN); 1775269ed8eeSAndrzej Hajda sii8620_mhl_burst_emsc_support_set((void *)buf, 1776269ed8eeSAndrzej Hajda MHL_BURST_ID_HID_PAYLOAD); 1777269ed8eeSAndrzej Hajda sii8620_write_buf(ctx, REG_MDT_XMIT_WRITE_PORT, buf, ARRAY_SIZE(buf)); 1778269ed8eeSAndrzej Hajda } 1779269ed8eeSAndrzej Hajda 1780e25f1f7cSMaciej Purski static bool sii8620_rcp_consume(struct sii8620 *ctx, u8 scancode) 1781e25f1f7cSMaciej Purski { 1782e25f1f7cSMaciej Purski bool pressed = !(scancode & MHL_RCP_KEY_RELEASED_MASK); 1783e25f1f7cSMaciej Purski 1784e25f1f7cSMaciej Purski scancode &= MHL_RCP_KEY_ID_MASK; 1785e25f1f7cSMaciej Purski 1786e25f1f7cSMaciej Purski if (!ctx->rc_dev) { 1787e25f1f7cSMaciej Purski dev_dbg(ctx->dev, "RCP input device not initialized\n"); 1788e25f1f7cSMaciej Purski return false; 1789e25f1f7cSMaciej Purski } 1790e25f1f7cSMaciej Purski 1791e25f1f7cSMaciej Purski if (pressed) 1792e25f1f7cSMaciej Purski rc_keydown(ctx->rc_dev, RC_PROTO_CEC, scancode, 0); 1793e25f1f7cSMaciej Purski else 1794e25f1f7cSMaciej Purski rc_keyup(ctx->rc_dev); 1795e25f1f7cSMaciej Purski 1796e25f1f7cSMaciej Purski return true; 1797e25f1f7cSMaciej Purski } 1798e25f1f7cSMaciej Purski 1799ce6e153fSAndrzej Hajda static void sii8620_msc_mr_set_int(struct sii8620 *ctx) 1800ce6e153fSAndrzej Hajda { 1801ce6e153fSAndrzej Hajda u8 ints[MHL_INT_SIZE]; 1802ce6e153fSAndrzej Hajda 1803ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_MHL_INT_0, ints, MHL_INT_SIZE); 1804ce6e153fSAndrzej Hajda sii8620_write_buf(ctx, REG_MHL_INT_0, ints, MHL_INT_SIZE); 18052c8fb853SAndrzej Hajda 18062c8fb853SAndrzej Hajda if (ints[MHL_INT_RCHANGE] & MHL_INT_RC_DCAP_CHG) { 18072c8fb853SAndrzej Hajda switch (ctx->mode) { 18082c8fb853SAndrzej Hajda case CM_MHL3: 18092c8fb853SAndrzej Hajda sii8620_mt_read_xdevcap_reg(ctx, MHL_XDC_ECBUS_SPEEDS); 18102c8fb853SAndrzej Hajda sii8620_mt_set_cont(ctx, sii8620_got_ecbus_speed); 18112c8fb853SAndrzej Hajda break; 18122c8fb853SAndrzej Hajda case CM_ECBUS_S: 18132c8fb853SAndrzej Hajda sii8620_mt_read_devcap(ctx, true); 18142c8fb853SAndrzej Hajda break; 18152c8fb853SAndrzej Hajda default: 18162c8fb853SAndrzej Hajda break; 18172c8fb853SAndrzej Hajda } 18182c8fb853SAndrzej Hajda } 1819269ed8eeSAndrzej Hajda if (ints[MHL_INT_RCHANGE] & MHL_INT_RC_FEAT_REQ) 1820269ed8eeSAndrzej Hajda sii8620_send_features(ctx); 1821269ed8eeSAndrzej Hajda if (ints[MHL_INT_RCHANGE] & MHL_INT_RC_FEAT_COMPLETE) 1822269ed8eeSAndrzej Hajda sii8620_edid_read(ctx, 0); 1823ce6e153fSAndrzej Hajda } 1824ce6e153fSAndrzej Hajda 1825ce6e153fSAndrzej Hajda static struct sii8620_mt_msg *sii8620_msc_msg_first(struct sii8620 *ctx) 1826ce6e153fSAndrzej Hajda { 1827ce6e153fSAndrzej Hajda struct device *dev = ctx->dev; 1828ce6e153fSAndrzej Hajda 1829ce6e153fSAndrzej Hajda if (list_empty(&ctx->mt_queue)) { 1830ce6e153fSAndrzej Hajda dev_err(dev, "unexpected MSC MT response\n"); 1831ce6e153fSAndrzej Hajda return NULL; 1832ce6e153fSAndrzej Hajda } 1833ce6e153fSAndrzej Hajda 1834ce6e153fSAndrzej Hajda return list_first_entry(&ctx->mt_queue, struct sii8620_mt_msg, node); 1835ce6e153fSAndrzej Hajda } 1836ce6e153fSAndrzej Hajda 1837ce6e153fSAndrzej Hajda static void sii8620_msc_mt_done(struct sii8620 *ctx) 1838ce6e153fSAndrzej Hajda { 1839ce6e153fSAndrzej Hajda struct sii8620_mt_msg *msg = sii8620_msc_msg_first(ctx); 1840ce6e153fSAndrzej Hajda 1841ce6e153fSAndrzej Hajda if (!msg) 1842ce6e153fSAndrzej Hajda return; 1843ce6e153fSAndrzej Hajda 1844ce6e153fSAndrzej Hajda msg->ret = sii8620_readb(ctx, REG_MSC_MT_RCVD_DATA0); 1845ce6e153fSAndrzej Hajda ctx->mt_state = MT_STATE_DONE; 1846ce6e153fSAndrzej Hajda } 1847ce6e153fSAndrzej Hajda 1848ce6e153fSAndrzej Hajda static void sii8620_msc_mr_msc_msg(struct sii8620 *ctx) 1849ce6e153fSAndrzej Hajda { 1850e25f1f7cSMaciej Purski struct sii8620_mt_msg *msg; 1851ce6e153fSAndrzej Hajda u8 buf[2]; 1852ce6e153fSAndrzej Hajda 1853ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_MSC_MR_MSC_MSG_RCVD_1ST_DATA, buf, 2); 1854ce6e153fSAndrzej Hajda 1855ce6e153fSAndrzej Hajda switch (buf[0]) { 1856ce6e153fSAndrzej Hajda case MHL_MSC_MSG_RAPK: 1857e25f1f7cSMaciej Purski msg = sii8620_msc_msg_first(ctx); 1858e25f1f7cSMaciej Purski if (!msg) 1859e25f1f7cSMaciej Purski return; 1860ce6e153fSAndrzej Hajda msg->ret = buf[1]; 1861ce6e153fSAndrzej Hajda ctx->mt_state = MT_STATE_DONE; 1862ce6e153fSAndrzej Hajda break; 1863e25f1f7cSMaciej Purski case MHL_MSC_MSG_RCP: 1864e25f1f7cSMaciej Purski if (!sii8620_rcp_consume(ctx, buf[1])) 1865e25f1f7cSMaciej Purski sii8620_mt_rcpe(ctx, 1866e25f1f7cSMaciej Purski MHL_RCPE_STATUS_INEFFECTIVE_KEY_CODE); 1867e25f1f7cSMaciej Purski sii8620_mt_rcpk(ctx, buf[1]); 1868e25f1f7cSMaciej Purski break; 1869ce6e153fSAndrzej Hajda default: 1870ce6e153fSAndrzej Hajda dev_err(ctx->dev, "%s message type %d,%d not supported", 1871ce6e153fSAndrzej Hajda __func__, buf[0], buf[1]); 1872ce6e153fSAndrzej Hajda } 1873ce6e153fSAndrzej Hajda } 1874ce6e153fSAndrzej Hajda 1875ce6e153fSAndrzej Hajda static void sii8620_irq_msc(struct sii8620 *ctx) 1876ce6e153fSAndrzej Hajda { 1877ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_CBUS_INT_0); 1878ce6e153fSAndrzej Hajda 1879ce6e153fSAndrzej Hajda if (stat & ~BIT_CBUS_HPD_CHG) 1880ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_CBUS_INT_0, stat & ~BIT_CBUS_HPD_CHG); 1881ce6e153fSAndrzej Hajda 1882ce6e153fSAndrzej Hajda if (stat & BIT_CBUS_HPD_CHG) { 1883ce6e153fSAndrzej Hajda u8 cbus_stat = sii8620_readb(ctx, REG_CBUS_STATUS); 1884ce6e153fSAndrzej Hajda 1885ce6e153fSAndrzej Hajda if ((cbus_stat ^ ctx->cbus_status) & BIT_CBUS_STATUS_CBUS_HPD) { 1886ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_CBUS_INT_0, BIT_CBUS_HPD_CHG); 1887ce6e153fSAndrzej Hajda } else { 1888ce6e153fSAndrzej Hajda stat ^= BIT_CBUS_STATUS_CBUS_HPD; 1889ce6e153fSAndrzej Hajda cbus_stat ^= BIT_CBUS_STATUS_CBUS_HPD; 1890ce6e153fSAndrzej Hajda } 1891ce6e153fSAndrzej Hajda ctx->cbus_status = cbus_stat; 1892ce6e153fSAndrzej Hajda } 1893ce6e153fSAndrzej Hajda 1894ce6e153fSAndrzej Hajda if (stat & BIT_CBUS_MSC_MR_WRITE_STAT) 1895ce6e153fSAndrzej Hajda sii8620_msc_mr_write_stat(ctx); 1896ce6e153fSAndrzej Hajda 1897ce6e153fSAndrzej Hajda if (stat & BIT_CBUS_MSC_MR_SET_INT) 1898ce6e153fSAndrzej Hajda sii8620_msc_mr_set_int(ctx); 1899ce6e153fSAndrzej Hajda 1900ce6e153fSAndrzej Hajda if (stat & BIT_CBUS_MSC_MT_DONE) 1901ce6e153fSAndrzej Hajda sii8620_msc_mt_done(ctx); 1902ce6e153fSAndrzej Hajda 1903ce6e153fSAndrzej Hajda if (stat & BIT_CBUS_MSC_MR_MSC_MSG) 1904ce6e153fSAndrzej Hajda sii8620_msc_mr_msc_msg(ctx); 1905ce6e153fSAndrzej Hajda } 1906ce6e153fSAndrzej Hajda 1907ce6e153fSAndrzej Hajda static void sii8620_irq_coc(struct sii8620 *ctx) 1908ce6e153fSAndrzej Hajda { 1909ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_COC_INTR); 1910ce6e153fSAndrzej Hajda 1911e19e9c69SAndrzej Hajda if (stat & BIT_COC_CALIBRATION_DONE) { 1912e19e9c69SAndrzej Hajda u8 cstat = sii8620_readb(ctx, REG_COC_STAT_0); 1913e19e9c69SAndrzej Hajda 1914e19e9c69SAndrzej Hajda cstat &= BIT_COC_STAT_0_PLL_LOCKED | MSK_COC_STAT_0_FSM_STATE; 1915e19e9c69SAndrzej Hajda if (cstat == (BIT_COC_STAT_0_PLL_LOCKED | 0x02)) { 1916e19e9c69SAndrzej Hajda sii8620_write_seq_static(ctx, 1917e19e9c69SAndrzej Hajda REG_COC_CTLB, 0, 1918e19e9c69SAndrzej Hajda REG_TRXINTMH, BIT_TDM_INTR_SYNC_DATA 1919e19e9c69SAndrzej Hajda | BIT_TDM_INTR_SYNC_WAIT 1920e19e9c69SAndrzej Hajda ); 1921e19e9c69SAndrzej Hajda } 1922e19e9c69SAndrzej Hajda } 1923e19e9c69SAndrzej Hajda 1924ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_COC_INTR, stat); 1925ce6e153fSAndrzej Hajda } 1926ce6e153fSAndrzej Hajda 1927ce6e153fSAndrzej Hajda static void sii8620_irq_merr(struct sii8620 *ctx) 1928ce6e153fSAndrzej Hajda { 1929ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_CBUS_INT_1); 1930ce6e153fSAndrzej Hajda 1931ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_CBUS_INT_1, stat); 1932ce6e153fSAndrzej Hajda } 1933ce6e153fSAndrzej Hajda 1934ce6e153fSAndrzej Hajda static void sii8620_irq_edid(struct sii8620 *ctx) 1935ce6e153fSAndrzej Hajda { 1936ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_INTR9); 1937ce6e153fSAndrzej Hajda 1938ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_INTR9, stat); 1939ce6e153fSAndrzej Hajda 1940ce6e153fSAndrzej Hajda if (stat & BIT_INTR9_DEVCAP_DONE) 1941ce6e153fSAndrzej Hajda ctx->mt_state = MT_STATE_DONE; 1942ce6e153fSAndrzej Hajda } 1943ce6e153fSAndrzej Hajda 1944ce6e153fSAndrzej Hajda static void sii8620_scdt_high(struct sii8620 *ctx) 1945ce6e153fSAndrzej Hajda { 1946ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 1947ce6e153fSAndrzej Hajda REG_INTR8_MASK, BIT_CEA_NEW_AVI | BIT_CEA_NEW_VSI, 1948ce6e153fSAndrzej Hajda REG_TPI_SC, BIT_TPI_SC_TPI_OUTPUT_MODE_0_HDMI, 1949ce6e153fSAndrzej Hajda ); 1950ce6e153fSAndrzej Hajda } 1951ce6e153fSAndrzej Hajda 1952ce6e153fSAndrzej Hajda static void sii8620_irq_scdt(struct sii8620 *ctx) 1953ce6e153fSAndrzej Hajda { 1954ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_INTR5); 1955ce6e153fSAndrzej Hajda 1956ce6e153fSAndrzej Hajda if (stat & BIT_INTR_SCDT_CHANGE) { 1957ce6e153fSAndrzej Hajda u8 cstat = sii8620_readb(ctx, REG_TMDS_CSTAT_P3); 1958ce6e153fSAndrzej Hajda 19595c632e22SMaciej Purski if (cstat & BIT_TMDS_CSTAT_P3_SCDT) { 19605c632e22SMaciej Purski if (ctx->sink_type == SINK_HDMI) 19615c632e22SMaciej Purski /* enable infoframe interrupt */ 1962ce6e153fSAndrzej Hajda sii8620_scdt_high(ctx); 19635c632e22SMaciej Purski else 19645c632e22SMaciej Purski sii8620_start_video(ctx); 19655c632e22SMaciej Purski } 1966ce6e153fSAndrzej Hajda } 1967ce6e153fSAndrzej Hajda 1968ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_INTR5, stat); 1969ce6e153fSAndrzej Hajda } 1970ce6e153fSAndrzej Hajda 1971ce6e153fSAndrzej Hajda static void sii8620_new_vsi(struct sii8620 *ctx) 1972ce6e153fSAndrzej Hajda { 1973ce6e153fSAndrzej Hajda u8 vsif[11]; 1974ce6e153fSAndrzej Hajda 1975ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_RX_HDMI_CTRL2, 1976ce6e153fSAndrzej Hajda VAL_RX_HDMI_CTRL2_DEFVAL | 1977ce6e153fSAndrzej Hajda BIT_RX_HDMI_CTRL2_VSI_MON_SEL_VSI); 1978ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_RX_HDMI_MON_PKT_HEADER1, vsif, 1979ce6e153fSAndrzej Hajda ARRAY_SIZE(vsif)); 1980ce6e153fSAndrzej Hajda } 1981ce6e153fSAndrzej Hajda 1982ce6e153fSAndrzej Hajda static void sii8620_new_avi(struct sii8620 *ctx) 1983ce6e153fSAndrzej Hajda { 1984ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_RX_HDMI_CTRL2, VAL_RX_HDMI_CTRL2_DEFVAL); 1985ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_RX_HDMI_MON_PKT_HEADER1, ctx->avif, 1986ce6e153fSAndrzej Hajda ARRAY_SIZE(ctx->avif)); 1987ce6e153fSAndrzej Hajda } 1988ce6e153fSAndrzej Hajda 1989ce6e153fSAndrzej Hajda static void sii8620_irq_infr(struct sii8620 *ctx) 1990ce6e153fSAndrzej Hajda { 1991ce6e153fSAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_INTR8) 1992ce6e153fSAndrzej Hajda & (BIT_CEA_NEW_VSI | BIT_CEA_NEW_AVI); 1993ce6e153fSAndrzej Hajda 1994ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_INTR8, stat); 1995ce6e153fSAndrzej Hajda 1996ce6e153fSAndrzej Hajda if (stat & BIT_CEA_NEW_VSI) 1997ce6e153fSAndrzej Hajda sii8620_new_vsi(ctx); 1998ce6e153fSAndrzej Hajda 1999ce6e153fSAndrzej Hajda if (stat & BIT_CEA_NEW_AVI) 2000ce6e153fSAndrzej Hajda sii8620_new_avi(ctx); 2001ce6e153fSAndrzej Hajda 2002ce6e153fSAndrzej Hajda if (stat & (BIT_CEA_NEW_VSI | BIT_CEA_NEW_AVI)) 2003ce6e153fSAndrzej Hajda sii8620_start_video(ctx); 2004ce6e153fSAndrzej Hajda } 2005ce6e153fSAndrzej Hajda 2006e3a65487SAndrzej Hajda static void sii8620_got_xdevcap(struct sii8620 *ctx, int ret) 2007e3a65487SAndrzej Hajda { 2008e3a65487SAndrzej Hajda if (ret < 0) 2009e3a65487SAndrzej Hajda return; 2010e3a65487SAndrzej Hajda 2011e3a65487SAndrzej Hajda sii8620_mt_read_devcap(ctx, false); 2012e3a65487SAndrzej Hajda } 2013e3a65487SAndrzej Hajda 2014e19e9c69SAndrzej Hajda static void sii8620_irq_tdm(struct sii8620 *ctx) 2015e19e9c69SAndrzej Hajda { 2016e19e9c69SAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_TRXINTH); 2017e19e9c69SAndrzej Hajda u8 tdm = sii8620_readb(ctx, REG_TRXSTA2); 2018e19e9c69SAndrzej Hajda 2019e19e9c69SAndrzej Hajda if ((tdm & MSK_TDM_SYNCHRONIZED) == VAL_TDM_SYNCHRONIZED) { 2020e19e9c69SAndrzej Hajda ctx->mode = CM_ECBUS_S; 2021e19e9c69SAndrzej Hajda ctx->burst.rx_ack = 0; 2022e19e9c69SAndrzej Hajda ctx->burst.r_size = SII8620_BURST_BUF_LEN; 2023e19e9c69SAndrzej Hajda sii8620_burst_tx_rbuf_info(ctx, SII8620_BURST_BUF_LEN); 2024e19e9c69SAndrzej Hajda sii8620_mt_read_devcap(ctx, true); 2025e3a65487SAndrzej Hajda sii8620_mt_set_cont(ctx, sii8620_got_xdevcap); 2026e19e9c69SAndrzej Hajda } else { 2027e19e9c69SAndrzej Hajda sii8620_write_seq_static(ctx, 2028e19e9c69SAndrzej Hajda REG_MHL_PLL_CTL2, 0, 2029e19e9c69SAndrzej Hajda REG_MHL_PLL_CTL2, BIT_MHL_PLL_CTL2_CLKDETECT_EN 2030e19e9c69SAndrzej Hajda ); 2031e19e9c69SAndrzej Hajda } 2032e19e9c69SAndrzej Hajda 2033e19e9c69SAndrzej Hajda sii8620_write(ctx, REG_TRXINTH, stat); 2034e19e9c69SAndrzej Hajda } 2035e19e9c69SAndrzej Hajda 2036e19e9c69SAndrzej Hajda static void sii8620_irq_block(struct sii8620 *ctx) 2037e19e9c69SAndrzej Hajda { 2038e19e9c69SAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_EMSCINTR); 2039e19e9c69SAndrzej Hajda 2040e19e9c69SAndrzej Hajda if (stat & BIT_EMSCINTR_SPI_DVLD) { 2041e19e9c69SAndrzej Hajda u8 bstat = sii8620_readb(ctx, REG_SPIBURSTSTAT); 2042e19e9c69SAndrzej Hajda 2043e19e9c69SAndrzej Hajda if (bstat & BIT_SPIBURSTSTAT_EMSC_NORMAL_MODE) 2044e19e9c69SAndrzej Hajda sii8620_burst_receive(ctx); 2045e19e9c69SAndrzej Hajda } 2046e19e9c69SAndrzej Hajda 2047e19e9c69SAndrzej Hajda sii8620_write(ctx, REG_EMSCINTR, stat); 2048e19e9c69SAndrzej Hajda } 2049e19e9c69SAndrzej Hajda 2050263b5c93SAndrzej Hajda static void sii8620_irq_ddc(struct sii8620 *ctx) 2051263b5c93SAndrzej Hajda { 2052263b5c93SAndrzej Hajda u8 stat = sii8620_readb(ctx, REG_INTR3); 2053263b5c93SAndrzej Hajda 2054263b5c93SAndrzej Hajda if (stat & BIT_DDC_CMD_DONE) { 2055263b5c93SAndrzej Hajda sii8620_write(ctx, REG_INTR3_MASK, 0); 2056263b5c93SAndrzej Hajda if (sii8620_is_mhl3(ctx)) 2057263b5c93SAndrzej Hajda sii8620_mt_set_int(ctx, MHL_INT_REG(RCHANGE), 2058263b5c93SAndrzej Hajda MHL_INT_RC_FEAT_REQ); 2059263b5c93SAndrzej Hajda else 2060263b5c93SAndrzej Hajda sii8620_edid_read(ctx, 0); 2061263b5c93SAndrzej Hajda } 2062263b5c93SAndrzej Hajda sii8620_write(ctx, REG_INTR3, stat); 2063263b5c93SAndrzej Hajda } 2064263b5c93SAndrzej Hajda 2065ce6e153fSAndrzej Hajda /* endian agnostic, non-volatile version of test_bit */ 2066ce6e153fSAndrzej Hajda static bool sii8620_test_bit(unsigned int nr, const u8 *addr) 2067ce6e153fSAndrzej Hajda { 2068ce6e153fSAndrzej Hajda return 1 & (addr[nr / BITS_PER_BYTE] >> (nr % BITS_PER_BYTE)); 2069ce6e153fSAndrzej Hajda } 2070ce6e153fSAndrzej Hajda 2071ce6e153fSAndrzej Hajda static irqreturn_t sii8620_irq_thread(int irq, void *data) 2072ce6e153fSAndrzej Hajda { 2073ce6e153fSAndrzej Hajda static const struct { 2074ce6e153fSAndrzej Hajda int bit; 2075ce6e153fSAndrzej Hajda void (*handler)(struct sii8620 *ctx); 2076ce6e153fSAndrzej Hajda } irq_vec[] = { 2077ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_DISC, sii8620_irq_disc }, 2078ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_G2WB, sii8620_irq_g2wb }, 2079ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_COC, sii8620_irq_coc }, 2080e19e9c69SAndrzej Hajda { BIT_FAST_INTR_STAT_TDM, sii8620_irq_tdm }, 2081ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_MSC, sii8620_irq_msc }, 2082ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_MERR, sii8620_irq_merr }, 2083e19e9c69SAndrzej Hajda { BIT_FAST_INTR_STAT_BLOCK, sii8620_irq_block }, 2084ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_EDID, sii8620_irq_edid }, 2085263b5c93SAndrzej Hajda { BIT_FAST_INTR_STAT_DDC, sii8620_irq_ddc }, 2086ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_SCDT, sii8620_irq_scdt }, 2087ce6e153fSAndrzej Hajda { BIT_FAST_INTR_STAT_INFR, sii8620_irq_infr }, 2088ce6e153fSAndrzej Hajda }; 2089ce6e153fSAndrzej Hajda struct sii8620 *ctx = data; 2090ce6e153fSAndrzej Hajda u8 stats[LEN_FAST_INTR_STAT]; 2091ce6e153fSAndrzej Hajda int i, ret; 2092ce6e153fSAndrzej Hajda 2093ce6e153fSAndrzej Hajda mutex_lock(&ctx->lock); 2094ce6e153fSAndrzej Hajda 2095ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_FAST_INTR_STAT, stats, ARRAY_SIZE(stats)); 2096ce6e153fSAndrzej Hajda for (i = 0; i < ARRAY_SIZE(irq_vec); ++i) 2097ce6e153fSAndrzej Hajda if (sii8620_test_bit(irq_vec[i].bit, stats)) 2098ce6e153fSAndrzej Hajda irq_vec[i].handler(ctx); 2099ce6e153fSAndrzej Hajda 2100e19e9c69SAndrzej Hajda sii8620_burst_rx_all(ctx); 2101ce6e153fSAndrzej Hajda sii8620_mt_work(ctx); 2102e19e9c69SAndrzej Hajda sii8620_burst_send(ctx); 2103ce6e153fSAndrzej Hajda 2104ce6e153fSAndrzej Hajda ret = sii8620_clear_error(ctx); 2105ce6e153fSAndrzej Hajda if (ret) { 2106ce6e153fSAndrzej Hajda dev_err(ctx->dev, "Error during IRQ handling, %d.\n", ret); 2107ce6e153fSAndrzej Hajda sii8620_mhl_disconnected(ctx); 2108ce6e153fSAndrzej Hajda } 2109ce6e153fSAndrzej Hajda mutex_unlock(&ctx->lock); 2110ce6e153fSAndrzej Hajda 2111ce6e153fSAndrzej Hajda return IRQ_HANDLED; 2112ce6e153fSAndrzej Hajda } 2113ce6e153fSAndrzej Hajda 2114ce6e153fSAndrzej Hajda static void sii8620_cable_in(struct sii8620 *ctx) 2115ce6e153fSAndrzej Hajda { 2116ce6e153fSAndrzej Hajda struct device *dev = ctx->dev; 2117ce6e153fSAndrzej Hajda u8 ver[5]; 2118ce6e153fSAndrzej Hajda int ret; 2119ce6e153fSAndrzej Hajda 2120ce6e153fSAndrzej Hajda ret = sii8620_hw_on(ctx); 2121ce6e153fSAndrzej Hajda if (ret) { 2122ce6e153fSAndrzej Hajda dev_err(dev, "Error powering on, %d.\n", ret); 2123ce6e153fSAndrzej Hajda return; 2124ce6e153fSAndrzej Hajda } 2125ce6e153fSAndrzej Hajda 2126ce6e153fSAndrzej Hajda sii8620_read_buf(ctx, REG_VND_IDL, ver, ARRAY_SIZE(ver)); 2127ce6e153fSAndrzej Hajda ret = sii8620_clear_error(ctx); 2128ce6e153fSAndrzej Hajda if (ret) { 2129ce6e153fSAndrzej Hajda dev_err(dev, "Error accessing I2C bus, %d.\n", ret); 2130ce6e153fSAndrzej Hajda return; 2131ce6e153fSAndrzej Hajda } 2132ce6e153fSAndrzej Hajda 2133ce6e153fSAndrzej Hajda dev_info(dev, "ChipID %02x%02x:%02x%02x rev %02x.\n", ver[1], ver[0], 2134ce6e153fSAndrzej Hajda ver[3], ver[2], ver[4]); 2135ce6e153fSAndrzej Hajda 2136ce6e153fSAndrzej Hajda sii8620_write(ctx, REG_DPD, 2137ce6e153fSAndrzej Hajda BIT_DPD_PWRON_PLL | BIT_DPD_PDNTX12 | BIT_DPD_OSC_EN); 2138ce6e153fSAndrzej Hajda 2139ce6e153fSAndrzej Hajda sii8620_xtal_set_rate(ctx); 2140ce6e153fSAndrzej Hajda sii8620_disconnect(ctx); 2141ce6e153fSAndrzej Hajda 2142ce6e153fSAndrzej Hajda sii8620_write_seq_static(ctx, 2143ce6e153fSAndrzej Hajda REG_MHL_CBUS_CTL0, VAL_MHL_CBUS_CTL0_CBUS_DRV_SEL_STRONG 2144ce6e153fSAndrzej Hajda | VAL_MHL_CBUS_CTL0_CBUS_RGND_VBIAS_734, 2145ce6e153fSAndrzej Hajda REG_MHL_CBUS_CTL1, VAL_MHL_CBUS_CTL1_1115_OHM, 2146ce6e153fSAndrzej Hajda REG_DPD, BIT_DPD_PWRON_PLL | BIT_DPD_PDNTX12 | BIT_DPD_OSC_EN, 2147ce6e153fSAndrzej Hajda ); 2148ce6e153fSAndrzej Hajda 2149ce6e153fSAndrzej Hajda ret = sii8620_clear_error(ctx); 2150ce6e153fSAndrzej Hajda if (ret) { 2151ce6e153fSAndrzej Hajda dev_err(dev, "Error accessing I2C bus, %d.\n", ret); 2152ce6e153fSAndrzej Hajda return; 2153ce6e153fSAndrzej Hajda } 2154ce6e153fSAndrzej Hajda 2155ce6e153fSAndrzej Hajda enable_irq(to_i2c_client(ctx->dev)->irq); 2156ce6e153fSAndrzej Hajda } 2157ce6e153fSAndrzej Hajda 2158e25f1f7cSMaciej Purski static void sii8620_init_rcp_input_dev(struct sii8620 *ctx) 2159e25f1f7cSMaciej Purski { 2160e25f1f7cSMaciej Purski struct rc_dev *rc_dev; 2161e25f1f7cSMaciej Purski int ret; 2162e25f1f7cSMaciej Purski 2163e25f1f7cSMaciej Purski rc_dev = rc_allocate_device(RC_DRIVER_SCANCODE); 2164e25f1f7cSMaciej Purski if (!rc_dev) { 2165e25f1f7cSMaciej Purski dev_err(ctx->dev, "Failed to allocate RC device\n"); 2166e25f1f7cSMaciej Purski ctx->error = -ENOMEM; 2167e25f1f7cSMaciej Purski return; 2168e25f1f7cSMaciej Purski } 2169e25f1f7cSMaciej Purski 2170e25f1f7cSMaciej Purski rc_dev->input_phys = "sii8620/input0"; 2171e25f1f7cSMaciej Purski rc_dev->input_id.bustype = BUS_VIRTUAL; 2172e25f1f7cSMaciej Purski rc_dev->map_name = RC_MAP_CEC; 2173e25f1f7cSMaciej Purski rc_dev->allowed_protocols = RC_PROTO_BIT_CEC; 2174e25f1f7cSMaciej Purski rc_dev->driver_name = "sii8620"; 2175e25f1f7cSMaciej Purski rc_dev->device_name = "sii8620"; 2176e25f1f7cSMaciej Purski 2177e25f1f7cSMaciej Purski ret = rc_register_device(rc_dev); 2178e25f1f7cSMaciej Purski 2179e25f1f7cSMaciej Purski if (ret) { 2180e25f1f7cSMaciej Purski dev_err(ctx->dev, "Failed to register RC device\n"); 2181e25f1f7cSMaciej Purski ctx->error = ret; 2182e25f1f7cSMaciej Purski rc_free_device(ctx->rc_dev); 2183e25f1f7cSMaciej Purski return; 2184e25f1f7cSMaciej Purski } 2185e25f1f7cSMaciej Purski ctx->rc_dev = rc_dev; 2186e25f1f7cSMaciej Purski } 2187e25f1f7cSMaciej Purski 218868883844SMaciej Purski static void sii8620_cable_out(struct sii8620 *ctx) 218968883844SMaciej Purski { 219068883844SMaciej Purski disable_irq(to_i2c_client(ctx->dev)->irq); 219168883844SMaciej Purski sii8620_hw_off(ctx); 219268883844SMaciej Purski } 219368883844SMaciej Purski 219468883844SMaciej Purski static void sii8620_extcon_work(struct work_struct *work) 219568883844SMaciej Purski { 219668883844SMaciej Purski struct sii8620 *ctx = 219768883844SMaciej Purski container_of(work, struct sii8620, extcon_wq); 219868883844SMaciej Purski int state = extcon_get_state(ctx->extcon, EXTCON_DISP_MHL); 219968883844SMaciej Purski 220068883844SMaciej Purski if (state == ctx->cable_state) 220168883844SMaciej Purski return; 220268883844SMaciej Purski 220368883844SMaciej Purski ctx->cable_state = state; 220468883844SMaciej Purski 220568883844SMaciej Purski if (state > 0) 220668883844SMaciej Purski sii8620_cable_in(ctx); 220768883844SMaciej Purski else 220868883844SMaciej Purski sii8620_cable_out(ctx); 220968883844SMaciej Purski } 221068883844SMaciej Purski 221168883844SMaciej Purski static int sii8620_extcon_notifier(struct notifier_block *self, 221268883844SMaciej Purski unsigned long event, void *ptr) 221368883844SMaciej Purski { 221468883844SMaciej Purski struct sii8620 *ctx = 221568883844SMaciej Purski container_of(self, struct sii8620, extcon_nb); 221668883844SMaciej Purski 221768883844SMaciej Purski schedule_work(&ctx->extcon_wq); 221868883844SMaciej Purski 221968883844SMaciej Purski return NOTIFY_DONE; 222068883844SMaciej Purski } 222168883844SMaciej Purski 222268883844SMaciej Purski static int sii8620_extcon_init(struct sii8620 *ctx) 222368883844SMaciej Purski { 222468883844SMaciej Purski struct extcon_dev *edev; 222568883844SMaciej Purski struct device_node *musb, *muic; 222668883844SMaciej Purski int ret; 222768883844SMaciej Purski 222868883844SMaciej Purski /* get micro-USB connector node */ 222968883844SMaciej Purski musb = of_graph_get_remote_node(ctx->dev->of_node, 1, -1); 223068883844SMaciej Purski /* next get micro-USB Interface Controller node */ 223168883844SMaciej Purski muic = of_get_next_parent(musb); 223268883844SMaciej Purski 223368883844SMaciej Purski if (!muic) { 223468883844SMaciej Purski dev_info(ctx->dev, "no extcon found, switching to 'always on' mode\n"); 223568883844SMaciej Purski return 0; 223668883844SMaciej Purski } 223768883844SMaciej Purski 223868883844SMaciej Purski edev = extcon_find_edev_by_node(muic); 223968883844SMaciej Purski of_node_put(muic); 224068883844SMaciej Purski if (IS_ERR(edev)) { 224168883844SMaciej Purski if (PTR_ERR(edev) == -EPROBE_DEFER) 224268883844SMaciej Purski return -EPROBE_DEFER; 224368883844SMaciej Purski dev_err(ctx->dev, "Invalid or missing extcon\n"); 224468883844SMaciej Purski return PTR_ERR(edev); 224568883844SMaciej Purski } 224668883844SMaciej Purski 224768883844SMaciej Purski ctx->extcon = edev; 224868883844SMaciej Purski ctx->extcon_nb.notifier_call = sii8620_extcon_notifier; 224968883844SMaciej Purski INIT_WORK(&ctx->extcon_wq, sii8620_extcon_work); 225068883844SMaciej Purski ret = extcon_register_notifier(edev, EXTCON_DISP_MHL, &ctx->extcon_nb); 225168883844SMaciej Purski if (ret) { 225268883844SMaciej Purski dev_err(ctx->dev, "failed to register notifier for MHL\n"); 225368883844SMaciej Purski return ret; 225468883844SMaciej Purski } 225568883844SMaciej Purski 225668883844SMaciej Purski return 0; 225768883844SMaciej Purski } 225868883844SMaciej Purski 2259ce6e153fSAndrzej Hajda static inline struct sii8620 *bridge_to_sii8620(struct drm_bridge *bridge) 2260ce6e153fSAndrzej Hajda { 2261ce6e153fSAndrzej Hajda return container_of(bridge, struct sii8620, bridge); 2262ce6e153fSAndrzej Hajda } 2263ce6e153fSAndrzej Hajda 2264e25f1f7cSMaciej Purski static int sii8620_attach(struct drm_bridge *bridge) 2265e25f1f7cSMaciej Purski { 2266e25f1f7cSMaciej Purski struct sii8620 *ctx = bridge_to_sii8620(bridge); 2267e25f1f7cSMaciej Purski 2268e25f1f7cSMaciej Purski sii8620_init_rcp_input_dev(ctx); 2269e25f1f7cSMaciej Purski 2270e25f1f7cSMaciej Purski return sii8620_clear_error(ctx); 2271e25f1f7cSMaciej Purski } 2272e25f1f7cSMaciej Purski 2273e25f1f7cSMaciej Purski static void sii8620_detach(struct drm_bridge *bridge) 2274e25f1f7cSMaciej Purski { 2275e25f1f7cSMaciej Purski struct sii8620 *ctx = bridge_to_sii8620(bridge); 2276e25f1f7cSMaciej Purski 2277e25f1f7cSMaciej Purski rc_unregister_device(ctx->rc_dev); 2278e25f1f7cSMaciej Purski } 2279e25f1f7cSMaciej Purski 2280ecba7cfaSMaciej Purski static int sii8620_is_packing_required(struct sii8620 *ctx, 2281ecba7cfaSMaciej Purski const struct drm_display_mode *mode) 2282ecba7cfaSMaciej Purski { 2283ecba7cfaSMaciej Purski int max_pclk, max_pclk_pp_mode; 2284ecba7cfaSMaciej Purski 2285ecba7cfaSMaciej Purski if (sii8620_is_mhl3(ctx)) { 2286ecba7cfaSMaciej Purski max_pclk = MHL3_MAX_PCLK; 2287ecba7cfaSMaciej Purski max_pclk_pp_mode = MHL3_MAX_PCLK_PP_MODE; 2288ecba7cfaSMaciej Purski } else { 2289ecba7cfaSMaciej Purski max_pclk = MHL1_MAX_PCLK; 2290ecba7cfaSMaciej Purski max_pclk_pp_mode = MHL1_MAX_PCLK_PP_MODE; 2291ecba7cfaSMaciej Purski } 2292ecba7cfaSMaciej Purski 2293ecba7cfaSMaciej Purski if (mode->clock < max_pclk) 2294ecba7cfaSMaciej Purski return 0; 2295ecba7cfaSMaciej Purski else if (mode->clock < max_pclk_pp_mode) 2296ecba7cfaSMaciej Purski return 1; 2297ecba7cfaSMaciej Purski else 2298ecba7cfaSMaciej Purski return -1; 2299ecba7cfaSMaciej Purski } 2300ecba7cfaSMaciej Purski 2301e7c2e4d3SMarek Szyprowski static enum drm_mode_status sii8620_mode_valid(struct drm_bridge *bridge, 2302e7c2e4d3SMarek Szyprowski const struct drm_display_mode *mode) 2303e7c2e4d3SMarek Szyprowski { 2304e7c2e4d3SMarek Szyprowski struct sii8620 *ctx = bridge_to_sii8620(bridge); 2305ecba7cfaSMaciej Purski int pack_required = sii8620_is_packing_required(ctx, mode); 2306e7c2e4d3SMarek Szyprowski bool can_pack = ctx->devcap[MHL_DCAP_VID_LINK_MODE] & 2307e7c2e4d3SMarek Szyprowski MHL_DCAP_VID_LINK_PPIXEL; 2308e7c2e4d3SMarek Szyprowski 2309ecba7cfaSMaciej Purski switch (pack_required) { 2310ecba7cfaSMaciej Purski case 0: 2311ecba7cfaSMaciej Purski return MODE_OK; 2312ecba7cfaSMaciej Purski case 1: 2313ecba7cfaSMaciej Purski return (can_pack) ? MODE_OK : MODE_CLOCK_HIGH; 2314ecba7cfaSMaciej Purski default: 2315ecba7cfaSMaciej Purski return MODE_CLOCK_HIGH; 2316ecba7cfaSMaciej Purski } 2317e7c2e4d3SMarek Szyprowski } 2318e7c2e4d3SMarek Szyprowski 2319ce6e153fSAndrzej Hajda static bool sii8620_mode_fixup(struct drm_bridge *bridge, 2320ce6e153fSAndrzej Hajda const struct drm_display_mode *mode, 2321ce6e153fSAndrzej Hajda struct drm_display_mode *adjusted_mode) 2322ce6e153fSAndrzej Hajda { 2323ce6e153fSAndrzej Hajda struct sii8620 *ctx = bridge_to_sii8620(bridge); 2324bf1722caSAndrzej Hajda 2325ce6e153fSAndrzej Hajda mutex_lock(&ctx->lock); 2326ce6e153fSAndrzej Hajda 2327ecba7cfaSMaciej Purski ctx->use_packed_pixel = sii8620_is_packing_required(ctx, adjusted_mode); 2328ecba7cfaSMaciej Purski ctx->video_code = drm_match_cea_mode(adjusted_mode); 2329bf1722caSAndrzej Hajda ctx->pixel_clock = adjusted_mode->clock; 2330ecba7cfaSMaciej Purski 2331ce6e153fSAndrzej Hajda mutex_unlock(&ctx->lock); 2332ecba7cfaSMaciej Purski 2333ecba7cfaSMaciej Purski return true; 2334ce6e153fSAndrzej Hajda } 2335ce6e153fSAndrzej Hajda 2336ce6e153fSAndrzej Hajda static const struct drm_bridge_funcs sii8620_bridge_funcs = { 2337e25f1f7cSMaciej Purski .attach = sii8620_attach, 2338e25f1f7cSMaciej Purski .detach = sii8620_detach, 2339ce6e153fSAndrzej Hajda .mode_fixup = sii8620_mode_fixup, 2340e7c2e4d3SMarek Szyprowski .mode_valid = sii8620_mode_valid, 2341ce6e153fSAndrzej Hajda }; 2342ce6e153fSAndrzej Hajda 2343ce6e153fSAndrzej Hajda static int sii8620_probe(struct i2c_client *client, 2344ce6e153fSAndrzej Hajda const struct i2c_device_id *id) 2345ce6e153fSAndrzej Hajda { 2346ce6e153fSAndrzej Hajda struct device *dev = &client->dev; 2347ce6e153fSAndrzej Hajda struct sii8620 *ctx; 2348ce6e153fSAndrzej Hajda int ret; 2349ce6e153fSAndrzej Hajda 2350ce6e153fSAndrzej Hajda ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL); 2351ce6e153fSAndrzej Hajda if (!ctx) 2352ce6e153fSAndrzej Hajda return -ENOMEM; 2353ce6e153fSAndrzej Hajda 2354ce6e153fSAndrzej Hajda ctx->dev = dev; 2355ce6e153fSAndrzej Hajda mutex_init(&ctx->lock); 2356ce6e153fSAndrzej Hajda INIT_LIST_HEAD(&ctx->mt_queue); 2357ce6e153fSAndrzej Hajda 2358ce6e153fSAndrzej Hajda ctx->clk_xtal = devm_clk_get(dev, "xtal"); 2359ce6e153fSAndrzej Hajda if (IS_ERR(ctx->clk_xtal)) { 2360ce6e153fSAndrzej Hajda dev_err(dev, "failed to get xtal clock from DT\n"); 2361ce6e153fSAndrzej Hajda return PTR_ERR(ctx->clk_xtal); 2362ce6e153fSAndrzej Hajda } 2363ce6e153fSAndrzej Hajda 2364ce6e153fSAndrzej Hajda if (!client->irq) { 2365ce6e153fSAndrzej Hajda dev_err(dev, "no irq provided\n"); 2366ce6e153fSAndrzej Hajda return -EINVAL; 2367ce6e153fSAndrzej Hajda } 2368ce6e153fSAndrzej Hajda irq_set_status_flags(client->irq, IRQ_NOAUTOEN); 2369ce6e153fSAndrzej Hajda ret = devm_request_threaded_irq(dev, client->irq, NULL, 2370ce6e153fSAndrzej Hajda sii8620_irq_thread, 2371ce6e153fSAndrzej Hajda IRQF_TRIGGER_HIGH | IRQF_ONESHOT, 2372ce6e153fSAndrzej Hajda "sii8620", ctx); 2373e0ba12eaSAndrzej Hajda if (ret < 0) { 2374e0ba12eaSAndrzej Hajda dev_err(dev, "failed to install IRQ handler\n"); 2375e0ba12eaSAndrzej Hajda return ret; 2376e0ba12eaSAndrzej Hajda } 2377ce6e153fSAndrzej Hajda 2378ce6e153fSAndrzej Hajda ctx->gpio_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH); 2379ce6e153fSAndrzej Hajda if (IS_ERR(ctx->gpio_reset)) { 2380ce6e153fSAndrzej Hajda dev_err(dev, "failed to get reset gpio from DT\n"); 2381ce6e153fSAndrzej Hajda return PTR_ERR(ctx->gpio_reset); 2382ce6e153fSAndrzej Hajda } 2383ce6e153fSAndrzej Hajda 2384ce6e153fSAndrzej Hajda ctx->supplies[0].supply = "cvcc10"; 2385ce6e153fSAndrzej Hajda ctx->supplies[1].supply = "iovcc18"; 2386ce6e153fSAndrzej Hajda ret = devm_regulator_bulk_get(dev, 2, ctx->supplies); 2387ce6e153fSAndrzej Hajda if (ret) 2388ce6e153fSAndrzej Hajda return ret; 2389ce6e153fSAndrzej Hajda 239068883844SMaciej Purski ret = sii8620_extcon_init(ctx); 239168883844SMaciej Purski if (ret < 0) { 239268883844SMaciej Purski dev_err(ctx->dev, "failed to initialize EXTCON\n"); 239368883844SMaciej Purski return ret; 239468883844SMaciej Purski } 239568883844SMaciej Purski 2396ce6e153fSAndrzej Hajda i2c_set_clientdata(client, ctx); 2397ce6e153fSAndrzej Hajda 2398ce6e153fSAndrzej Hajda ctx->bridge.funcs = &sii8620_bridge_funcs; 2399ce6e153fSAndrzej Hajda ctx->bridge.of_node = dev->of_node; 2400ce6e153fSAndrzej Hajda drm_bridge_add(&ctx->bridge); 2401ce6e153fSAndrzej Hajda 240268883844SMaciej Purski if (!ctx->extcon) 2403ce6e153fSAndrzej Hajda sii8620_cable_in(ctx); 2404ce6e153fSAndrzej Hajda 2405ce6e153fSAndrzej Hajda return 0; 2406ce6e153fSAndrzej Hajda } 2407ce6e153fSAndrzej Hajda 2408ce6e153fSAndrzej Hajda static int sii8620_remove(struct i2c_client *client) 2409ce6e153fSAndrzej Hajda { 2410ce6e153fSAndrzej Hajda struct sii8620 *ctx = i2c_get_clientdata(client); 2411ce6e153fSAndrzej Hajda 241268883844SMaciej Purski if (ctx->extcon) { 241368883844SMaciej Purski extcon_unregister_notifier(ctx->extcon, EXTCON_DISP_MHL, 241468883844SMaciej Purski &ctx->extcon_nb); 241568883844SMaciej Purski flush_work(&ctx->extcon_wq); 241668883844SMaciej Purski if (ctx->cable_state > 0) 241768883844SMaciej Purski sii8620_cable_out(ctx); 241868883844SMaciej Purski } else { 241968883844SMaciej Purski sii8620_cable_out(ctx); 242068883844SMaciej Purski } 2421e25f1f7cSMaciej Purski drm_bridge_remove(&ctx->bridge); 2422ce6e153fSAndrzej Hajda 2423ce6e153fSAndrzej Hajda return 0; 2424ce6e153fSAndrzej Hajda } 2425ce6e153fSAndrzej Hajda 2426ce6e153fSAndrzej Hajda static const struct of_device_id sii8620_dt_match[] = { 2427ce6e153fSAndrzej Hajda { .compatible = "sil,sii8620" }, 2428ce6e153fSAndrzej Hajda { }, 2429ce6e153fSAndrzej Hajda }; 2430ce6e153fSAndrzej Hajda MODULE_DEVICE_TABLE(of, sii8620_dt_match); 2431ce6e153fSAndrzej Hajda 2432ce6e153fSAndrzej Hajda static const struct i2c_device_id sii8620_id[] = { 2433ce6e153fSAndrzej Hajda { "sii8620", 0 }, 2434ce6e153fSAndrzej Hajda { }, 2435ce6e153fSAndrzej Hajda }; 2436ce6e153fSAndrzej Hajda 2437ce6e153fSAndrzej Hajda MODULE_DEVICE_TABLE(i2c, sii8620_id); 2438ce6e153fSAndrzej Hajda static struct i2c_driver sii8620_driver = { 2439ce6e153fSAndrzej Hajda .driver = { 2440ce6e153fSAndrzej Hajda .name = "sii8620", 2441ce6e153fSAndrzej Hajda .of_match_table = of_match_ptr(sii8620_dt_match), 2442ce6e153fSAndrzej Hajda }, 2443ce6e153fSAndrzej Hajda .probe = sii8620_probe, 2444ce6e153fSAndrzej Hajda .remove = sii8620_remove, 2445ce6e153fSAndrzej Hajda .id_table = sii8620_id, 2446ce6e153fSAndrzej Hajda }; 2447ce6e153fSAndrzej Hajda 2448ce6e153fSAndrzej Hajda module_i2c_driver(sii8620_driver); 2449ce6e153fSAndrzej Hajda MODULE_LICENSE("GPL v2"); 2450