1 /* drivers/media/platform/s5p-cec/exynos_hdmi_cecctrl.c
3 * Copyright (c) 2009, 2014 Samsung Electronics
4 * http://www.samsung.com/
6 * cec ftn file for Samsung TVOUT driver
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
14 #include <linux/device.h>
16 #include "exynos_hdmi_cec.h"
19 #define S5P_HDMI_FIN 24000000
20 #define CEC_DIV_RATIO 320000
22 #define CEC_MESSAGE_BROADCAST_MASK 0x0F
23 #define CEC_MESSAGE_BROADCAST 0x0F
24 #define CEC_FILTER_THRESHOLD 0x15
26 void s5p_cec_set_divider(struct s5p_cec_dev *cec)
28 u32 div_ratio, div_val;
31 div_ratio = S5P_HDMI_FIN / CEC_DIV_RATIO - 1;
33 if (regmap_read(cec->pmu, EXYNOS_HDMI_PHY_CONTROL, ®)) {
34 dev_err(cec->dev, "failed to read phy control\n");
38 reg = (reg & ~(0x3FF << 16)) | (div_ratio << 16);
40 if (regmap_write(cec->pmu, EXYNOS_HDMI_PHY_CONTROL, reg)) {
41 dev_err(cec->dev, "failed to write phy control\n");
45 div_val = CEC_DIV_RATIO * 0.00005 - 1;
47 writeb(0x0, cec->reg + S5P_CEC_DIVISOR_3);
48 writeb(0x0, cec->reg + S5P_CEC_DIVISOR_2);
49 writeb(0x0, cec->reg + S5P_CEC_DIVISOR_1);
50 writeb(div_val, cec->reg + S5P_CEC_DIVISOR_0);
53 void s5p_cec_enable_rx(struct s5p_cec_dev *cec)
57 reg = readb(cec->reg + S5P_CEC_RX_CTRL);
58 reg |= S5P_CEC_RX_CTRL_ENABLE;
59 writeb(reg, cec->reg + S5P_CEC_RX_CTRL);
62 void s5p_cec_mask_rx_interrupts(struct s5p_cec_dev *cec)
66 reg = readb(cec->reg + S5P_CEC_IRQ_MASK);
67 reg |= S5P_CEC_IRQ_RX_DONE;
68 reg |= S5P_CEC_IRQ_RX_ERROR;
69 writeb(reg, cec->reg + S5P_CEC_IRQ_MASK);
72 void s5p_cec_unmask_rx_interrupts(struct s5p_cec_dev *cec)
76 reg = readb(cec->reg + S5P_CEC_IRQ_MASK);
77 reg &= ~S5P_CEC_IRQ_RX_DONE;
78 reg &= ~S5P_CEC_IRQ_RX_ERROR;
79 writeb(reg, cec->reg + S5P_CEC_IRQ_MASK);
82 void s5p_cec_mask_tx_interrupts(struct s5p_cec_dev *cec)
86 reg = readb(cec->reg + S5P_CEC_IRQ_MASK);
87 reg |= S5P_CEC_IRQ_TX_DONE;
88 reg |= S5P_CEC_IRQ_TX_ERROR;
89 writeb(reg, cec->reg + S5P_CEC_IRQ_MASK);
93 void s5p_cec_unmask_tx_interrupts(struct s5p_cec_dev *cec)
97 reg = readb(cec->reg + S5P_CEC_IRQ_MASK);
98 reg &= ~S5P_CEC_IRQ_TX_DONE;
99 reg &= ~S5P_CEC_IRQ_TX_ERROR;
100 writeb(reg, cec->reg + S5P_CEC_IRQ_MASK);
103 void s5p_cec_reset(struct s5p_cec_dev *cec)
107 writeb(S5P_CEC_RX_CTRL_RESET, cec->reg + S5P_CEC_RX_CTRL);
108 writeb(S5P_CEC_TX_CTRL_RESET, cec->reg + S5P_CEC_TX_CTRL);
110 reg = readb(cec->reg + 0xc4);
112 writeb(reg, cec->reg + 0xc4);
115 void s5p_cec_tx_reset(struct s5p_cec_dev *cec)
117 writeb(S5P_CEC_TX_CTRL_RESET, cec->reg + S5P_CEC_TX_CTRL);
120 void s5p_cec_rx_reset(struct s5p_cec_dev *cec)
124 writeb(S5P_CEC_RX_CTRL_RESET, cec->reg + S5P_CEC_RX_CTRL);
126 reg = readb(cec->reg + 0xc4);
128 writeb(reg, cec->reg + 0xc4);
131 void s5p_cec_threshold(struct s5p_cec_dev *cec)
133 writeb(CEC_FILTER_THRESHOLD, cec->reg + S5P_CEC_RX_FILTER_TH);
134 writeb(0, cec->reg + S5P_CEC_RX_FILTER_CTRL);
137 void s5p_cec_copy_packet(struct s5p_cec_dev *cec, char *data,
138 size_t count, u8 retries)
144 writeb(data[i], cec->reg + (S5P_CEC_TX_BUFF0 + (i * 4)));
148 writeb(count, cec->reg + S5P_CEC_TX_BYTES);
149 reg = readb(cec->reg + S5P_CEC_TX_CTRL);
150 reg |= S5P_CEC_TX_CTRL_START;
154 if ((data[0] & CEC_MESSAGE_BROADCAST_MASK) == CEC_MESSAGE_BROADCAST) {
155 dev_dbg(cec->dev, "Broadcast");
156 reg |= S5P_CEC_TX_CTRL_BCAST;
158 dev_dbg(cec->dev, "No Broadcast");
159 reg &= ~S5P_CEC_TX_CTRL_BCAST;
162 writeb(reg, cec->reg + S5P_CEC_TX_CTRL);
163 dev_dbg(cec->dev, "cec-tx: cec count (%zu): %*ph", count,
167 void s5p_cec_set_addr(struct s5p_cec_dev *cec, u32 addr)
169 writeb(addr & 0x0F, cec->reg + S5P_CEC_LOGIC_ADDR);
172 u32 s5p_cec_get_status(struct s5p_cec_dev *cec)
176 status = readb(cec->reg + S5P_CEC_STATUS_0);
177 status |= readb(cec->reg + S5P_CEC_STATUS_1) << 8;
178 status |= readb(cec->reg + S5P_CEC_STATUS_2) << 16;
179 status |= readb(cec->reg + S5P_CEC_STATUS_3) << 24;
181 dev_dbg(cec->dev, "status = 0x%x!\n", status);
186 void s5p_clr_pending_tx(struct s5p_cec_dev *cec)
188 writeb(S5P_CEC_IRQ_TX_DONE | S5P_CEC_IRQ_TX_ERROR,
189 cec->reg + S5P_CEC_IRQ_CLEAR);
192 void s5p_clr_pending_rx(struct s5p_cec_dev *cec)
194 writeb(S5P_CEC_IRQ_RX_DONE | S5P_CEC_IRQ_RX_ERROR,
195 cec->reg + S5P_CEC_IRQ_CLEAR);
198 void s5p_cec_get_rx_buf(struct s5p_cec_dev *cec, u32 size, u8 *buffer)
204 buffer[i] = readb(cec->reg + S5P_CEC_RX_BUFF0 + (i * 4));
205 sprintf(debug + i * 2, "%02x ", buffer[i]);
208 dev_dbg(cec->dev, "cec-rx: cec size(%d): %s", size, debug);