kernel/drivers/gpu/drm/msm/hdmi/hdmi_phy_8x74.c

   1 /*
   2  * Copyright (C) 2013 Red Hat
   3  * Author: Rob Clark <robdclark@gmail.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of the GNU General Public License version 2 as published by
   7  * the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program.  If not, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #include "hdmi.h"
  19
  20 struct hdmi_phy_8x74 {
  21         struct hdmi_phy base;
  22         struct hdmi *hdmi;
  23         void __iomem *mmio;
  24 };
  25 #define to_hdmi_phy_8x74(x) container_of(x, struct hdmi_phy_8x74, base)
  26
  27
  28 static void phy_write(struct hdmi_phy_8x74 *phy, u32 reg, u32 data)
  29 {
  30         msm_writel(data, phy->mmio + reg);
  31 }
  32
  33 //static u32 phy_read(struct hdmi_phy_8x74 *phy, u32 reg)
  34 //{
  35 //      return msm_readl(phy->mmio + reg);
  36 //}
  37
  38 static void hdmi_phy_8x74_destroy(struct hdmi_phy *phy)
  39 {
  40         struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
  41         kfree(phy_8x74);
  42 }
  43
  44 static void hdmi_phy_8x74_reset(struct hdmi_phy *phy)
  45 {
  46         struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
  47         struct hdmi *hdmi = phy_8x74->hdmi;
  48         unsigned int val;
  49
  50         /* NOTE that HDMI_PHY_CTL is in core mmio, not phy mmio: */
  51
  52         val = hdmi_read(hdmi, REG_HDMI_PHY_CTRL);
  53
  54         if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
  55                 /* pull low */
  56                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  57                                 val & ~HDMI_PHY_CTRL_SW_RESET);
  58         } else {
  59                 /* pull high */
  60                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  61                                 val | HDMI_PHY_CTRL_SW_RESET);
  62         }
  63
  64         if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
  65                 /* pull low */
  66                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  67                                 val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
  68         } else {
  69                 /* pull high */
  70                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  71                                 val | HDMI_PHY_CTRL_SW_RESET_PLL);
  72         }
  73
  74         msleep(100);
  75
  76         if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
  77                 /* pull high */
  78                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  79                                 val | HDMI_PHY_CTRL_SW_RESET);
  80         } else {
  81                 /* pull low */
  82                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  83                                 val & ~HDMI_PHY_CTRL_SW_RESET);
  84         }
  85
  86         if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
  87                 /* pull high */
  88                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  89                                 val | HDMI_PHY_CTRL_SW_RESET_PLL);
  90         } else {
  91                 /* pull low */
  92                 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
  93                                 val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
  94         }
  95 }
  96
  97 static void hdmi_phy_8x74_powerup(struct hdmi_phy *phy,
  98                 unsigned long int pixclock)
  99 {
 100         struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
 101
 102         phy_write(phy_8x74, REG_HDMI_8x74_ANA_CFG0,   0x1b);
 103         phy_write(phy_8x74, REG_HDMI_8x74_ANA_CFG1,   0xf2);
 104         phy_write(phy_8x74, REG_HDMI_8x74_BIST_CFG0,  0x0);
 105         phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN0, 0x0);
 106         phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN1, 0x0);
 107         phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN2, 0x0);
 108         phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN3, 0x0);
 109         phy_write(phy_8x74, REG_HDMI_8x74_PD_CTRL1,   0x20);
 110 }
 111
 112 static void hdmi_phy_8x74_powerdown(struct hdmi_phy *phy)
 113 {
 114         struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
 115         phy_write(phy_8x74, REG_HDMI_8x74_PD_CTRL0, 0x7f);
 116 }
 117
 118 static const struct hdmi_phy_funcs hdmi_phy_8x74_funcs = {
 119                 .destroy = hdmi_phy_8x74_destroy,
 120                 .reset = hdmi_phy_8x74_reset,
 121                 .powerup = hdmi_phy_8x74_powerup,
 122                 .powerdown = hdmi_phy_8x74_powerdown,
 123 };
 124
 125 struct hdmi_phy *hdmi_phy_8x74_init(struct hdmi *hdmi)
 126 {
 127         struct hdmi_phy_8x74 *phy_8x74;
 128         struct hdmi_phy *phy = NULL;
 129         int ret;
 130
 131         phy_8x74 = kzalloc(sizeof(*phy_8x74), GFP_KERNEL);
 132         if (!phy_8x74) {
 133                 ret = -ENOMEM;
 134                 goto fail;
 135         }
 136
 137         phy = &phy_8x74->base;
 138
 139         phy->funcs = &hdmi_phy_8x74_funcs;
 140
 141         phy_8x74->hdmi = hdmi;
 142
 143         /* for 8x74, the phy mmio is mapped separately: */
 144         phy_8x74->mmio = msm_ioremap(hdmi->pdev,
 145                         "phy_physical", "HDMI_8x74");
 146         if (IS_ERR(phy_8x74->mmio)) {
 147                 ret = PTR_ERR(phy_8x74->mmio);
 148                 goto fail;
 149         }
 150
 151         return phy;
 152
 153 fail:
 154         if (phy)
 155                 hdmi_phy_8x74_destroy(phy);
 156         return ERR_PTR(ret);
 157 }