1 /* 2 * HDMI CEC 3 * 4 * Based on the CEC code from hdmi_ti_4xxx_ip.c from Android. 5 * 6 * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/ 7 * Authors: Yong Zhi 8 * Mythri pk <mythripk@ti.com> 9 * 10 * Heavily modified to use the linux CEC framework: 11 * 12 * Copyright 2016-2017 Cisco Systems, Inc. and/or its affiliates. All rights reserved. 13 * 14 * This program is free software; you may redistribute it and/or modify 15 * it under the terms of the GNU General Public License as published by 16 * the Free Software Foundation; version 2 of the License. 17 * 18 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 19 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 20 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 21 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 22 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 23 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 24 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 25 * SOFTWARE. 26 */ 27 28 #include <linux/kernel.h> 29 #include <linux/err.h> 30 #include <linux/io.h> 31 #include <linux/platform_device.h> 32 #include <linux/slab.h> 33 34 #include "dss.h" 35 #include "hdmi.h" 36 #include "hdmi4_core.h" 37 #include "hdmi4_cec.h" 38 39 /* HDMI CEC */ 40 #define HDMI_CEC_DEV_ID 0x900 41 #define HDMI_CEC_SPEC 0x904 42 43 /* Not really a debug register, more a low-level control register */ 44 #define HDMI_CEC_DBG_3 0x91C 45 #define HDMI_CEC_TX_INIT 0x920 46 #define HDMI_CEC_TX_DEST 0x924 47 #define HDMI_CEC_SETUP 0x938 48 #define HDMI_CEC_TX_COMMAND 0x93C 49 #define HDMI_CEC_TX_OPERAND 0x940 50 #define HDMI_CEC_TRANSMIT_DATA 0x97C 51 #define HDMI_CEC_CA_7_0 0x988 52 #define HDMI_CEC_CA_15_8 0x98C 53 #define HDMI_CEC_INT_STATUS_0 0x998 54 #define HDMI_CEC_INT_STATUS_1 0x99C 55 #define HDMI_CEC_INT_ENABLE_0 0x990 56 #define HDMI_CEC_INT_ENABLE_1 0x994 57 #define HDMI_CEC_RX_CONTROL 0x9B0 58 #define HDMI_CEC_RX_COUNT 0x9B4 59 #define HDMI_CEC_RX_CMD_HEADER 0x9B8 60 #define HDMI_CEC_RX_COMMAND 0x9BC 61 #define HDMI_CEC_RX_OPERAND 0x9C0 62 63 #define HDMI_CEC_TX_FIFO_INT_MASK 0x64 64 #define HDMI_CEC_RETRANSMIT_CNT_INT_MASK 0x2 65 66 #define HDMI_CORE_CEC_RETRY 200 67 68 static void hdmi_cec_received_msg(struct hdmi_core_data *core) 69 { 70 u32 cnt = hdmi_read_reg(core->base, HDMI_CEC_RX_COUNT) & 0xff; 71 72 /* While there are CEC frames in the FIFO */ 73 while (cnt & 0x70) { 74 /* and the frame doesn't have an error */ 75 if (!(cnt & 0x80)) { 76 struct cec_msg msg = {}; 77 unsigned int i; 78 79 /* then read the message */ 80 msg.len = cnt & 0xf; 81 if (msg.len > CEC_MAX_MSG_SIZE - 2) 82 msg.len = CEC_MAX_MSG_SIZE - 2; 83 msg.msg[0] = hdmi_read_reg(core->base, 84 HDMI_CEC_RX_CMD_HEADER); 85 msg.msg[1] = hdmi_read_reg(core->base, 86 HDMI_CEC_RX_COMMAND); 87 for (i = 0; i < msg.len; i++) { 88 unsigned int reg = HDMI_CEC_RX_OPERAND + i * 4; 89 90 msg.msg[2 + i] = 91 hdmi_read_reg(core->base, reg); 92 } 93 msg.len += 2; 94 cec_received_msg(core->adap, &msg); 95 } 96 /* Clear the current frame from the FIFO */ 97 hdmi_write_reg(core->base, HDMI_CEC_RX_CONTROL, 1); 98 /* Wait until the current frame is cleared */ 99 while (hdmi_read_reg(core->base, HDMI_CEC_RX_CONTROL) & 1) 100 udelay(1); 101 /* 102 * Re-read the count register and loop to see if there are 103 * more messages in the FIFO. 104 */ 105 cnt = hdmi_read_reg(core->base, HDMI_CEC_RX_COUNT) & 0xff; 106 } 107 } 108 109 void hdmi4_cec_irq(struct hdmi_core_data *core) 110 { 111 u32 stat0 = hdmi_read_reg(core->base, HDMI_CEC_INT_STATUS_0); 112 u32 stat1 = hdmi_read_reg(core->base, HDMI_CEC_INT_STATUS_1); 113 114 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_0, stat0); 115 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_1, stat1); 116 117 if (stat0 & 0x20) { 118 cec_transmit_done(core->adap, CEC_TX_STATUS_OK, 119 0, 0, 0, 0); 120 REG_FLD_MOD(core->base, HDMI_CEC_DBG_3, 0x1, 7, 7); 121 } else if (stat1 & 0x02) { 122 u32 dbg3 = hdmi_read_reg(core->base, HDMI_CEC_DBG_3); 123 124 cec_transmit_done(core->adap, 125 CEC_TX_STATUS_NACK | 126 CEC_TX_STATUS_MAX_RETRIES, 127 0, (dbg3 >> 4) & 7, 0, 0); 128 REG_FLD_MOD(core->base, HDMI_CEC_DBG_3, 0x1, 7, 7); 129 } 130 if (stat0 & 0x02) 131 hdmi_cec_received_msg(core); 132 } 133 134 static bool hdmi_cec_clear_tx_fifo(struct cec_adapter *adap) 135 { 136 struct hdmi_core_data *core = cec_get_drvdata(adap); 137 int retry = HDMI_CORE_CEC_RETRY; 138 int temp; 139 140 REG_FLD_MOD(core->base, HDMI_CEC_DBG_3, 0x1, 7, 7); 141 while (retry) { 142 temp = hdmi_read_reg(core->base, HDMI_CEC_DBG_3); 143 if (FLD_GET(temp, 7, 7) == 0) 144 break; 145 retry--; 146 } 147 return retry != 0; 148 } 149 150 static bool hdmi_cec_clear_rx_fifo(struct cec_adapter *adap) 151 { 152 struct hdmi_core_data *core = cec_get_drvdata(adap); 153 int retry = HDMI_CORE_CEC_RETRY; 154 int temp; 155 156 hdmi_write_reg(core->base, HDMI_CEC_RX_CONTROL, 0x3); 157 retry = HDMI_CORE_CEC_RETRY; 158 while (retry) { 159 temp = hdmi_read_reg(core->base, HDMI_CEC_RX_CONTROL); 160 if (FLD_GET(temp, 1, 0) == 0) 161 break; 162 retry--; 163 } 164 return retry != 0; 165 } 166 167 static int hdmi_cec_adap_enable(struct cec_adapter *adap, bool enable) 168 { 169 struct hdmi_core_data *core = cec_get_drvdata(adap); 170 int temp, err; 171 172 if (!enable) { 173 hdmi_write_reg(core->base, HDMI_CEC_INT_ENABLE_0, 0); 174 hdmi_write_reg(core->base, HDMI_CEC_INT_ENABLE_1, 0); 175 REG_FLD_MOD(core->base, HDMI_CORE_SYS_INTR_UNMASK4, 0, 3, 3); 176 hdmi_wp_clear_irqenable(core->wp, HDMI_IRQ_CORE); 177 hdmi_wp_set_irqstatus(core->wp, HDMI_IRQ_CORE); 178 hdmi4_core_disable(NULL); 179 return 0; 180 } 181 err = hdmi4_core_enable(NULL); 182 if (err) 183 return err; 184 185 /* Clear TX FIFO */ 186 if (!hdmi_cec_clear_tx_fifo(adap)) { 187 pr_err("cec-%s: could not clear TX FIFO\n", adap->name); 188 return -EIO; 189 } 190 191 /* Clear RX FIFO */ 192 if (!hdmi_cec_clear_rx_fifo(adap)) { 193 pr_err("cec-%s: could not clear RX FIFO\n", adap->name); 194 return -EIO; 195 } 196 197 /* Clear CEC interrupts */ 198 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_1, 199 hdmi_read_reg(core->base, HDMI_CEC_INT_STATUS_1)); 200 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_0, 201 hdmi_read_reg(core->base, HDMI_CEC_INT_STATUS_0)); 202 203 /* Enable HDMI core interrupts */ 204 hdmi_wp_set_irqenable(core->wp, HDMI_IRQ_CORE); 205 /* Unmask CEC interrupt */ 206 REG_FLD_MOD(core->base, HDMI_CORE_SYS_INTR_UNMASK4, 0x1, 3, 3); 207 /* 208 * Enable CEC interrupts: 209 * Transmit Buffer Full/Empty Change event 210 * Receiver FIFO Not Empty event 211 */ 212 hdmi_write_reg(core->base, HDMI_CEC_INT_ENABLE_0, 0x22); 213 /* 214 * Enable CEC interrupts: 215 * Frame Retransmit Count Exceeded event 216 */ 217 hdmi_write_reg(core->base, HDMI_CEC_INT_ENABLE_1, 0x02); 218 219 /* cec calibration enable (self clearing) */ 220 hdmi_write_reg(core->base, HDMI_CEC_SETUP, 0x03); 221 msleep(20); 222 hdmi_write_reg(core->base, HDMI_CEC_SETUP, 0x04); 223 224 temp = hdmi_read_reg(core->base, HDMI_CEC_SETUP); 225 if (FLD_GET(temp, 4, 4) != 0) { 226 temp = FLD_MOD(temp, 0, 4, 4); 227 hdmi_write_reg(core->base, HDMI_CEC_SETUP, temp); 228 229 /* 230 * If we enabled CEC in middle of a CEC message on the bus, 231 * we could have start bit irregularity and/or short 232 * pulse event. Clear them now. 233 */ 234 temp = hdmi_read_reg(core->base, HDMI_CEC_INT_STATUS_1); 235 temp = FLD_MOD(0x0, 0x5, 2, 0); 236 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_1, temp); 237 } 238 return 0; 239 } 240 241 static int hdmi_cec_adap_log_addr(struct cec_adapter *adap, u8 log_addr) 242 { 243 struct hdmi_core_data *core = cec_get_drvdata(adap); 244 u32 v; 245 246 if (log_addr == CEC_LOG_ADDR_INVALID) { 247 hdmi_write_reg(core->base, HDMI_CEC_CA_7_0, 0); 248 hdmi_write_reg(core->base, HDMI_CEC_CA_15_8, 0); 249 return 0; 250 } 251 if (log_addr <= 7) { 252 v = hdmi_read_reg(core->base, HDMI_CEC_CA_7_0); 253 v |= 1 << log_addr; 254 hdmi_write_reg(core->base, HDMI_CEC_CA_7_0, v); 255 } else { 256 v = hdmi_read_reg(core->base, HDMI_CEC_CA_15_8); 257 v |= 1 << (log_addr - 8); 258 hdmi_write_reg(core->base, HDMI_CEC_CA_15_8, v); 259 } 260 return 0; 261 } 262 263 static int hdmi_cec_adap_transmit(struct cec_adapter *adap, u8 attempts, 264 u32 signal_free_time, struct cec_msg *msg) 265 { 266 struct hdmi_core_data *core = cec_get_drvdata(adap); 267 int temp; 268 u32 i; 269 270 /* Clear TX FIFO */ 271 if (!hdmi_cec_clear_tx_fifo(adap)) { 272 pr_err("cec-%s: could not clear TX FIFO for transmit\n", 273 adap->name); 274 return -EIO; 275 } 276 277 /* Clear TX interrupts */ 278 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_0, 279 HDMI_CEC_TX_FIFO_INT_MASK); 280 281 hdmi_write_reg(core->base, HDMI_CEC_INT_STATUS_1, 282 HDMI_CEC_RETRANSMIT_CNT_INT_MASK); 283 284 /* Set the retry count */ 285 REG_FLD_MOD(core->base, HDMI_CEC_DBG_3, attempts - 1, 6, 4); 286 287 /* Set the initiator addresses */ 288 hdmi_write_reg(core->base, HDMI_CEC_TX_INIT, cec_msg_initiator(msg)); 289 290 /* Set destination id */ 291 temp = cec_msg_destination(msg); 292 if (msg->len == 1) 293 temp |= 0x80; 294 hdmi_write_reg(core->base, HDMI_CEC_TX_DEST, temp); 295 if (msg->len == 1) 296 return 0; 297 298 /* Setup command and arguments for the command */ 299 hdmi_write_reg(core->base, HDMI_CEC_TX_COMMAND, msg->msg[1]); 300 301 for (i = 0; i < msg->len - 2; i++) 302 hdmi_write_reg(core->base, HDMI_CEC_TX_OPERAND + i * 4, 303 msg->msg[2 + i]); 304 305 /* Operand count */ 306 hdmi_write_reg(core->base, HDMI_CEC_TRANSMIT_DATA, 307 (msg->len - 2) | 0x10); 308 return 0; 309 } 310 311 static const struct cec_adap_ops hdmi_cec_adap_ops = { 312 .adap_enable = hdmi_cec_adap_enable, 313 .adap_log_addr = hdmi_cec_adap_log_addr, 314 .adap_transmit = hdmi_cec_adap_transmit, 315 }; 316 317 void hdmi4_cec_set_phys_addr(struct hdmi_core_data *core, u16 pa) 318 { 319 cec_s_phys_addr(core->adap, pa, false); 320 } 321 322 int hdmi4_cec_init(struct platform_device *pdev, struct hdmi_core_data *core, 323 struct hdmi_wp_data *wp) 324 { 325 const u32 caps = CEC_CAP_TRANSMIT | CEC_CAP_LOG_ADDRS | 326 CEC_CAP_PASSTHROUGH | CEC_CAP_RC; 327 int ret; 328 329 core->adap = cec_allocate_adapter(&hdmi_cec_adap_ops, core, 330 "omap4", caps, CEC_MAX_LOG_ADDRS); 331 ret = PTR_ERR_OR_ZERO(core->adap); 332 if (ret < 0) 333 return ret; 334 core->wp = wp; 335 336 /* 337 * Initialize CEC clock divider: CEC needs 2MHz clock hence 338 * set the devider to 24 to get 48/24=2MHz clock 339 */ 340 REG_FLD_MOD(core->wp->base, HDMI_WP_CLK, 0x18, 5, 0); 341 342 ret = cec_register_adapter(core->adap, &pdev->dev); 343 if (ret < 0) { 344 cec_delete_adapter(core->adap); 345 return ret; 346 } 347 return 0; 348 } 349 350 void hdmi4_cec_uninit(struct hdmi_core_data *core) 351 { 352 cec_unregister_adapter(core->adap); 353 } 354