drivers/staging/media/s5p-cec/exynos_hdmi_cecctrl.c

   1 /* drivers/media/platform/s5p-cec/exynos_hdmi_cecctrl.c
   2  *
   3  * Copyright (c) 2009, 2014 Samsung Electronics
   4  *              http://www.samsung.com/
   5  *
   6  * cec ftn file for Samsung TVOUT driver
   7  *
   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.
  11  */
  12
  13 #include <linux/io.h>
  14 #include <linux/device.h>
  15
  16 #include "exynos_hdmi_cec.h"
  17 #include "regs-cec.h"
  18
  19 #define S5P_HDMI_FIN                    24000000
  20 #define CEC_DIV_RATIO                   320000
  21
  22 #define CEC_MESSAGE_BROADCAST_MASK      0x0F
  23 #define CEC_MESSAGE_BROADCAST           0x0F
  24 #define CEC_FILTER_THRESHOLD            0x15
  25
  26 void s5p_cec_set_divider(struct s5p_cec_dev *cec)
  27 {
  28         u32 div_ratio, div_val;
  29         unsigned int reg;
  30
  31         div_ratio  = S5P_HDMI_FIN / CEC_DIV_RATIO - 1;
  32
  33         if (regmap_read(cec->pmu, EXYNOS_HDMI_PHY_CONTROL, &reg)) {
  34                 dev_err(cec->dev, "failed to read phy control\n");
  35                 return;
  36         }
  37
  38         reg = (reg & ~(0x3FF << 16)) | (div_ratio << 16);
  39
  40         if (regmap_write(cec->pmu, EXYNOS_HDMI_PHY_CONTROL, reg)) {
  41                 dev_err(cec->dev, "failed to write phy control\n");
  42                 return;
  43         }
  44
  45         div_val = CEC_DIV_RATIO * 0.00005 - 1;
  46
  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);
  51 }
  52
  53 void s5p_cec_enable_rx(struct s5p_cec_dev *cec)
  54 {
  55         u8 reg;
  56
  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);
  60 }
  61
  62 void s5p_cec_mask_rx_interrupts(struct s5p_cec_dev *cec)
  63 {
  64         u8 reg;
  65
  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);
  70 }
  71
  72 void s5p_cec_unmask_rx_interrupts(struct s5p_cec_dev *cec)
  73 {
  74         u8 reg;
  75
  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);
  80 }
  81
  82 void s5p_cec_mask_tx_interrupts(struct s5p_cec_dev *cec)
  83 {
  84         u8 reg;
  85
  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);
  90
  91 }
  92
  93 void s5p_cec_unmask_tx_interrupts(struct s5p_cec_dev *cec)
  94 {
  95         u8 reg;
  96
  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);
 101 }
 102
 103 void s5p_cec_reset(struct s5p_cec_dev *cec)
 104 {
 105         u8 reg;
 106
 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);
 109
 110         reg = readb(cec->reg + 0xc4);
 111         reg &= ~0x1;
 112         writeb(reg, cec->reg + 0xc4);
 113 }
 114
 115 void s5p_cec_tx_reset(struct s5p_cec_dev *cec)
 116 {
 117         writeb(S5P_CEC_TX_CTRL_RESET, cec->reg + S5P_CEC_TX_CTRL);
 118 }
 119
 120 void s5p_cec_rx_reset(struct s5p_cec_dev *cec)
 121 {
 122         u8 reg;
 123
 124         writeb(S5P_CEC_RX_CTRL_RESET, cec->reg + S5P_CEC_RX_CTRL);
 125
 126         reg = readb(cec->reg + 0xc4);
 127         reg &= ~0x1;
 128         writeb(reg, cec->reg + 0xc4);
 129 }
 130
 131 void s5p_cec_threshold(struct s5p_cec_dev *cec)
 132 {
 133         writeb(CEC_FILTER_THRESHOLD, cec->reg + S5P_CEC_RX_FILTER_TH);
 134         writeb(0, cec->reg + S5P_CEC_RX_FILTER_CTRL);
 135 }
 136
 137 void s5p_cec_copy_packet(struct s5p_cec_dev *cec, char *data,
 138                          size_t count, u8 retries)
 139 {
 140         int i = 0;
 141         u8 reg;
 142
 143         while (i < count) {
 144                 writeb(data[i], cec->reg + (S5P_CEC_TX_BUFF0 + (i * 4)));
 145                 i++;
 146         }
 147
 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;
 151         reg &= ~0x70;
 152         reg |= retries << 4;
 153
 154         if ((data[0] & CEC_MESSAGE_BROADCAST_MASK) == CEC_MESSAGE_BROADCAST) {
 155                 dev_dbg(cec->dev, "Broadcast");
 156                 reg |= S5P_CEC_TX_CTRL_BCAST;
 157         } else {
 158                 dev_dbg(cec->dev, "No Broadcast");
 159                 reg &= ~S5P_CEC_TX_CTRL_BCAST;
 160         }
 161
 162         writeb(reg, cec->reg + S5P_CEC_TX_CTRL);
 163         dev_dbg(cec->dev, "cec-tx: cec count (%zu): %*ph", count,
 164                 (int)count, data);
 165 }
 166
 167 void s5p_cec_set_addr(struct s5p_cec_dev *cec, u32 addr)
 168 {
 169         writeb(addr & 0x0F, cec->reg + S5P_CEC_LOGIC_ADDR);
 170 }
 171
 172 u32 s5p_cec_get_status(struct s5p_cec_dev *cec)
 173 {
 174         u32 status = 0;
 175
 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;
 180
 181         dev_dbg(cec->dev, "status = 0x%x!\n", status);
 182
 183         return status;
 184 }
 185
 186 void s5p_clr_pending_tx(struct s5p_cec_dev *cec)
 187 {
 188         writeb(S5P_CEC_IRQ_TX_DONE | S5P_CEC_IRQ_TX_ERROR,
 189                                         cec->reg + S5P_CEC_IRQ_CLEAR);
 190 }
 191
 192 void s5p_clr_pending_rx(struct s5p_cec_dev *cec)
 193 {
 194         writeb(S5P_CEC_IRQ_RX_DONE | S5P_CEC_IRQ_RX_ERROR,
 195                                         cec->reg + S5P_CEC_IRQ_CLEAR);
 196 }
 197
 198 void s5p_cec_get_rx_buf(struct s5p_cec_dev *cec, u32 size, u8 *buffer)
 199 {
 200         u32 i = 0;
 201         char debug[40];
 202
 203         while (i < size) {
 204                 buffer[i] = readb(cec->reg + S5P_CEC_RX_BUFF0 + (i * 4));
 205                 sprintf(debug + i * 2, "%02x ", buffer[i]);
 206                 i++;
 207         }
 208         dev_dbg(cec->dev, "cec-rx: cec size(%d): %s", size, debug);
 209 }