2019-05-27 14:55:01 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
2017-05-28 00:09:35 +08:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2016 Free Electrons
|
|
|
|
* Copyright (C) 2016 NextThing Co
|
|
|
|
*
|
|
|
|
* Maxime Ripard <maxime.ripard@free-electrons.com>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/clk-provider.h>
|
2019-04-19 06:20:22 +08:00
|
|
|
#include <linux/io.h>
|
2017-05-28 00:09:35 +08:00
|
|
|
|
|
|
|
#include "sun4i_hdmi.h"
|
|
|
|
|
|
|
|
struct sun4i_tmds {
|
|
|
|
struct clk_hw hw;
|
|
|
|
struct sun4i_hdmi *hdmi;
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
|
|
|
|
u8 div_offset;
|
2017-05-28 00:09:35 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static inline struct sun4i_tmds *hw_to_tmds(struct clk_hw *hw)
|
|
|
|
{
|
|
|
|
return container_of(hw, struct sun4i_tmds, hw);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static unsigned long sun4i_tmds_calc_divider(unsigned long rate,
|
|
|
|
unsigned long parent_rate,
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
u8 div_offset,
|
2017-05-28 00:09:35 +08:00
|
|
|
u8 *div,
|
|
|
|
bool *half)
|
|
|
|
{
|
|
|
|
unsigned long best_rate = 0;
|
|
|
|
u8 best_m = 0, m;
|
2018-10-22 00:34:45 +08:00
|
|
|
bool is_double = false;
|
2017-05-28 00:09:35 +08:00
|
|
|
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
for (m = div_offset ?: 1; m < (16 + div_offset); m++) {
|
2017-05-28 00:09:35 +08:00
|
|
|
u8 d;
|
|
|
|
|
|
|
|
for (d = 1; d < 3; d++) {
|
|
|
|
unsigned long tmp_rate;
|
|
|
|
|
|
|
|
tmp_rate = parent_rate / m / d;
|
|
|
|
|
|
|
|
if (tmp_rate > rate)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
if (!best_rate ||
|
|
|
|
(rate - tmp_rate) < (rate - best_rate)) {
|
|
|
|
best_rate = tmp_rate;
|
|
|
|
best_m = m;
|
2018-10-22 00:34:46 +08:00
|
|
|
is_double = (d == 2) ? true : false;
|
2017-05-28 00:09:35 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (div && half) {
|
|
|
|
*div = best_m;
|
|
|
|
*half = is_double;
|
|
|
|
}
|
|
|
|
|
|
|
|
return best_rate;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int sun4i_tmds_determine_rate(struct clk_hw *hw,
|
|
|
|
struct clk_rate_request *req)
|
|
|
|
{
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
struct sun4i_tmds *tmds = hw_to_tmds(hw);
|
2017-10-10 11:20:02 +08:00
|
|
|
struct clk_hw *parent = NULL;
|
2017-05-28 00:09:35 +08:00
|
|
|
unsigned long best_parent = 0;
|
|
|
|
unsigned long rate = req->rate;
|
|
|
|
int best_div = 1, best_half = 1;
|
2017-10-10 11:20:02 +08:00
|
|
|
int i, j, p;
|
2017-05-28 00:09:35 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* We only consider PLL3, since the TCON is very likely to be
|
|
|
|
* clocked from it, and to have the same rate than our HDMI
|
|
|
|
* clock, so we should not need to do anything.
|
|
|
|
*/
|
|
|
|
|
2017-10-10 11:20:02 +08:00
|
|
|
for (p = 0; p < clk_hw_get_num_parents(hw); p++) {
|
|
|
|
parent = clk_hw_get_parent_by_index(hw, p);
|
|
|
|
if (!parent)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
for (i = 1; i < 3; i++) {
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
for (j = tmds->div_offset ?: 1;
|
|
|
|
j < (16 + tmds->div_offset); j++) {
|
2017-10-10 11:20:02 +08:00
|
|
|
unsigned long ideal = rate * i * j;
|
|
|
|
unsigned long rounded;
|
|
|
|
|
|
|
|
rounded = clk_hw_round_rate(parent, ideal);
|
|
|
|
|
|
|
|
if (rounded == ideal) {
|
|
|
|
best_parent = rounded;
|
|
|
|
best_half = i;
|
|
|
|
best_div = j;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2018-01-09 10:03:23 +08:00
|
|
|
if (!best_parent ||
|
|
|
|
abs(rate - rounded / i / j) <
|
|
|
|
abs(rate - best_parent / best_half /
|
|
|
|
best_div)) {
|
2017-10-10 11:20:02 +08:00
|
|
|
best_parent = rounded;
|
2018-01-09 10:03:23 +08:00
|
|
|
best_half = i;
|
2018-01-09 10:03:22 +08:00
|
|
|
best_div = j;
|
2017-10-10 11:20:02 +08:00
|
|
|
}
|
2017-05-28 00:09:35 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-10-10 11:20:02 +08:00
|
|
|
if (!parent)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2017-05-28 00:09:35 +08:00
|
|
|
out:
|
|
|
|
req->rate = best_parent / best_half / best_div;
|
|
|
|
req->best_parent_rate = best_parent;
|
|
|
|
req->best_parent_hw = parent;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned long sun4i_tmds_recalc_rate(struct clk_hw *hw,
|
|
|
|
unsigned long parent_rate)
|
|
|
|
{
|
|
|
|
struct sun4i_tmds *tmds = hw_to_tmds(hw);
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
reg = readl(tmds->hdmi->base + SUN4I_HDMI_PAD_CTRL1_REG);
|
|
|
|
if (reg & SUN4I_HDMI_PAD_CTRL1_HALVE_CLK)
|
|
|
|
parent_rate /= 2;
|
|
|
|
|
|
|
|
reg = readl(tmds->hdmi->base + SUN4I_HDMI_PLL_CTRL_REG);
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
reg = ((reg >> 4) & 0xf) + tmds->div_offset;
|
2017-05-28 00:09:35 +08:00
|
|
|
if (!reg)
|
|
|
|
reg = 1;
|
|
|
|
|
|
|
|
return parent_rate / reg;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sun4i_tmds_set_rate(struct clk_hw *hw, unsigned long rate,
|
|
|
|
unsigned long parent_rate)
|
|
|
|
{
|
|
|
|
struct sun4i_tmds *tmds = hw_to_tmds(hw);
|
|
|
|
bool half;
|
|
|
|
u32 reg;
|
|
|
|
u8 div;
|
|
|
|
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
sun4i_tmds_calc_divider(rate, parent_rate, tmds->div_offset,
|
|
|
|
&div, &half);
|
2017-05-28 00:09:35 +08:00
|
|
|
|
|
|
|
reg = readl(tmds->hdmi->base + SUN4I_HDMI_PAD_CTRL1_REG);
|
|
|
|
reg &= ~SUN4I_HDMI_PAD_CTRL1_HALVE_CLK;
|
|
|
|
if (half)
|
|
|
|
reg |= SUN4I_HDMI_PAD_CTRL1_HALVE_CLK;
|
|
|
|
writel(reg, tmds->hdmi->base + SUN4I_HDMI_PAD_CTRL1_REG);
|
|
|
|
|
|
|
|
reg = readl(tmds->hdmi->base + SUN4I_HDMI_PLL_CTRL_REG);
|
|
|
|
reg &= ~SUN4I_HDMI_PLL_CTRL_DIV_MASK;
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
writel(reg | SUN4I_HDMI_PLL_CTRL_DIV(div - tmds->div_offset),
|
2017-05-28 00:09:35 +08:00
|
|
|
tmds->hdmi->base + SUN4I_HDMI_PLL_CTRL_REG);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static u8 sun4i_tmds_get_parent(struct clk_hw *hw)
|
|
|
|
{
|
|
|
|
struct sun4i_tmds *tmds = hw_to_tmds(hw);
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
reg = readl(tmds->hdmi->base + SUN4I_HDMI_PLL_DBG0_REG);
|
|
|
|
return ((reg & SUN4I_HDMI_PLL_DBG0_TMDS_PARENT_MASK) >>
|
|
|
|
SUN4I_HDMI_PLL_DBG0_TMDS_PARENT_SHIFT);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sun4i_tmds_set_parent(struct clk_hw *hw, u8 index)
|
|
|
|
{
|
|
|
|
struct sun4i_tmds *tmds = hw_to_tmds(hw);
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
if (index > 1)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
reg = readl(tmds->hdmi->base + SUN4I_HDMI_PLL_DBG0_REG);
|
|
|
|
reg &= ~SUN4I_HDMI_PLL_DBG0_TMDS_PARENT_MASK;
|
|
|
|
writel(reg | SUN4I_HDMI_PLL_DBG0_TMDS_PARENT(index),
|
|
|
|
tmds->hdmi->base + SUN4I_HDMI_PLL_DBG0_REG);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct clk_ops sun4i_tmds_ops = {
|
|
|
|
.determine_rate = sun4i_tmds_determine_rate,
|
|
|
|
.recalc_rate = sun4i_tmds_recalc_rate,
|
|
|
|
.set_rate = sun4i_tmds_set_rate,
|
|
|
|
|
|
|
|
.get_parent = sun4i_tmds_get_parent,
|
|
|
|
.set_parent = sun4i_tmds_set_parent,
|
|
|
|
};
|
|
|
|
|
|
|
|
int sun4i_tmds_create(struct sun4i_hdmi *hdmi)
|
|
|
|
{
|
|
|
|
struct clk_init_data init;
|
|
|
|
struct sun4i_tmds *tmds;
|
|
|
|
const char *parents[2];
|
|
|
|
|
|
|
|
parents[0] = __clk_get_name(hdmi->pll0_clk);
|
|
|
|
if (!parents[0])
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
parents[1] = __clk_get_name(hdmi->pll1_clk);
|
|
|
|
if (!parents[1])
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
tmds = devm_kzalloc(hdmi->dev, sizeof(*tmds), GFP_KERNEL);
|
|
|
|
if (!tmds)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
init.name = "hdmi-tmds";
|
|
|
|
init.ops = &sun4i_tmds_ops;
|
|
|
|
init.parent_names = parents;
|
|
|
|
init.num_parents = 2;
|
|
|
|
init.flags = CLK_SET_RATE_PARENT;
|
|
|
|
|
|
|
|
tmds->hdmi = hdmi;
|
|
|
|
tmds->hw.init = &init;
|
drm/sun4i: hdmi: Add support for controller hardware variants
The HDMI controller found in earlier Allwinner SoCs have slight
differences between the A10, A10s, and the A31:
- Need different initial values for the PLL related registers
- Different behavior of the DDC and TMDS clocks
- Different register layout for the DDC portion
- Separate DDC parent clock on the A31
- Explicit reset control
For the A31, the HDMI TMDS clock has a different value offset for
the divider. The HDMI DDC block is different from the one in the
other SoCs. As far as the DDC clock goes, it has no pre-divider,
as it is clocked from a slower parent clock, not the TMDS clock.
The divider offset from the register value is different. And the
clock control register is at a different offset.
A new variant data structure is created to store pointers to the
above functions, structures, and the different initial values.
Another flag notates whether there is a separate DDC parent clock.
If not, the TMDS clock is passed to the DDC clock create function,
as before.
Regmap fields are used to deal with the different register layout
of the DDC block.
Signed-off-by: Chen-Yu Tsai <wens@csie.org>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20171010032008.682-8-wens@csie.org
2017-10-10 11:20:04 +08:00
|
|
|
tmds->div_offset = hdmi->variant->tmds_clk_div_offset;
|
2017-05-28 00:09:35 +08:00
|
|
|
|
|
|
|
hdmi->tmds_clk = devm_clk_register(hdmi->dev, &tmds->hw);
|
|
|
|
if (IS_ERR(hdmi->tmds_clk))
|
|
|
|
return PTR_ERR(hdmi->tmds_clk);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|