cregit-Linux how code gets into the kernel

Release 4.17 drivers/gpu/drm/meson/meson_vclk.c

/*
 * Copyright (C) 2016 BayLibre, SAS
 * Author: Neil Armstrong <narmstrong@baylibre.com>
 * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of the
 * License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <drm/drmP.h>
#include "meson_drv.h"
#include "meson_vclk.h"

/**
 * DOC: Video Clocks
 *
 * VCLK is the "Pixel Clock" frequency generator from a dedicated PLL.
 * We handle the following encodings :
 *
 * - CVBS 27MHz generator via the VCLK2 to the VENCI and VDAC blocks
 * - HDMI Pixel Clocks generation
 *
 * What is missing :
 *
 * - Genenate Pixel clocks for 2K/4K 10bit formats
 *
 * Clock generator scheme :
 *
 * .. code::
 *
 *    __________   _________            _____
 *   |          | |         |          |     |--ENCI
 *   | HDMI PLL |-| PLL_DIV |--- VCLK--|     |--ENCL
 *   |__________| |_________| \        | MUX |--ENCP
 *                             --VCLK2-|     |--VDAC
 *                                     |_____|--HDMI-TX
 *
 * Final clocks can take input for either VCLK or VCLK2, but
 * VCLK is the preferred path for HDMI clocking and VCLK2 is the
 * preferred path for CVBS VDAC clocking.
 *
 * VCLK and VCLK2 have fixed divided clocks paths for /1, /2, /4, /6 or /12.
 *
 * The PLL_DIV can achieve an additional fractional dividing like
 * 1.5, 3.5, 3.75... to generate special 2K and 4K 10bit clocks.
 */

/* HHI Registers */

#define HHI_VID_PLL_CLK_DIV	0x1a0 
/* 0x68 offset in data sheet */

#define VID_PLL_EN		BIT(19)

#define VID_PLL_BYPASS		BIT(18)

#define VID_PLL_PRESET		BIT(15)

#define HHI_VIID_CLK_DIV	0x128 
/* 0x4a offset in data sheet */

#define VCLK2_DIV_MASK		0xff

#define VCLK2_DIV_EN		BIT(16)

#define VCLK2_DIV_RESET		BIT(17)

#define CTS_VDAC_SEL_MASK	(0xf << 28)

#define CTS_VDAC_SEL_SHIFT	28

#define HHI_VIID_CLK_CNTL	0x12c 
/* 0x4b offset in data sheet */

#define VCLK2_EN		BIT(19)

#define VCLK2_SEL_MASK		(0x7 << 16)

#define VCLK2_SEL_SHIFT		16

#define VCLK2_SOFT_RESET	BIT(15)

#define VCLK2_DIV1_EN		BIT(0)

#define HHI_VID_CLK_DIV		0x164 
/* 0x59 offset in data sheet */

#define VCLK_DIV_MASK		0xff

#define VCLK_DIV_EN		BIT(16)

#define VCLK_DIV_RESET		BIT(17)

#define CTS_ENCP_SEL_MASK	(0xf << 24)

#define CTS_ENCP_SEL_SHIFT	24

#define CTS_ENCI_SEL_MASK	(0xf << 28)

#define CTS_ENCI_SEL_SHIFT	28

#define HHI_VID_CLK_CNTL	0x17c 
/* 0x5f offset in data sheet */

#define VCLK_EN			BIT(19)

#define VCLK_SEL_MASK		(0x7 << 16)

#define VCLK_SEL_SHIFT		16

#define VCLK_SOFT_RESET		BIT(15)

#define VCLK_DIV1_EN		BIT(0)

#define VCLK_DIV2_EN		BIT(1)

#define VCLK_DIV4_EN		BIT(2)

#define VCLK_DIV6_EN		BIT(3)

#define VCLK_DIV12_EN		BIT(4)

#define HHI_VID_CLK_CNTL2	0x194 
/* 0x65 offset in data sheet */

#define CTS_ENCI_EN		BIT(0)

#define CTS_ENCP_EN		BIT(2)

#define CTS_VDAC_EN		BIT(4)

#define HDMI_TX_PIXEL_EN	BIT(5)

#define HHI_HDMI_CLK_CNTL	0x1cc 
/* 0x73 offset in data sheet */

#define HDMI_TX_PIXEL_SEL_MASK	(0xf << 16)

#define HDMI_TX_PIXEL_SEL_SHIFT	16

#define CTS_HDMI_SYS_SEL_MASK	(0x7 << 9)

#define CTS_HDMI_SYS_DIV_MASK	(0x7f)

#define CTS_HDMI_SYS_EN		BIT(8)


#define HHI_VDAC_CNTL0		0x2F4 
/* 0xbd offset in data sheet */

#define HHI_VDAC_CNTL1		0x2F8 
/* 0xbe offset in data sheet */


#define HHI_HDMI_PLL_CNTL	0x320 
/* 0xc8 offset in data sheet */

#define HHI_HDMI_PLL_CNTL2	0x324 
/* 0xc9 offset in data sheet */

#define HHI_HDMI_PLL_CNTL3	0x328 
/* 0xca offset in data sheet */

#define HHI_HDMI_PLL_CNTL4	0x32C 
/* 0xcb offset in data sheet */

#define HHI_HDMI_PLL_CNTL5	0x330 
/* 0xcc offset in data sheet */

#define HHI_HDMI_PLL_CNTL6	0x334 
/* 0xcd offset in data sheet */


#define HDMI_PLL_RESET		BIT(28)

#define HDMI_PLL_LOCK		BIT(31)

/* VID PLL Dividers */

enum {
	
VID_PLL_DIV_1 = 0,
	
VID_PLL_DIV_2,
	
VID_PLL_DIV_2p5,
	
VID_PLL_DIV_3,
	
VID_PLL_DIV_3p5,
	
VID_PLL_DIV_3p75,
	
VID_PLL_DIV_4,
	
VID_PLL_DIV_5,
	
VID_PLL_DIV_6,
	
VID_PLL_DIV_6p25,
	
VID_PLL_DIV_7,
	
VID_PLL_DIV_7p5,
	
VID_PLL_DIV_12,
	
VID_PLL_DIV_14,
	
VID_PLL_DIV_15,
};


void meson_vid_pll_set(struct meson_drm *priv, unsigned int div) { unsigned int shift_val = 0; unsigned int shift_sel = 0; /* Disable vid_pll output clock */ regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_EN, 0); regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_PRESET, 0); switch (div) { case VID_PLL_DIV_2: shift_val = 0x0aaa; shift_sel = 0; break; case VID_PLL_DIV_2p5: shift_val = 0x5294; shift_sel = 2; break; case VID_PLL_DIV_3: shift_val = 0x0db6; shift_sel = 0; break; case VID_PLL_DIV_3p5: shift_val = 0x36cc; shift_sel = 1; break; case VID_PLL_DIV_3p75: shift_val = 0x6666; shift_sel = 2; break; case VID_PLL_DIV_4: shift_val = 0x0ccc; shift_sel = 0; break; case VID_PLL_DIV_5: shift_val = 0x739c; shift_sel = 2; break; case VID_PLL_DIV_6: shift_val = 0x0e38; shift_sel = 0; break; case VID_PLL_DIV_6p25: shift_val = 0x0000; shift_sel = 3; break; case VID_PLL_DIV_7: shift_val = 0x3c78; shift_sel = 1; break; case VID_PLL_DIV_7p5: shift_val = 0x78f0; shift_sel = 2; break; case VID_PLL_DIV_12: shift_val = 0x0fc0; shift_sel = 0; break; case VID_PLL_DIV_14: shift_val = 0x3f80; shift_sel = 1; break; case VID_PLL_DIV_15: shift_val = 0x7f80; shift_sel = 2; break; } if (div == VID_PLL_DIV_1) /* Enable vid_pll bypass to HDMI pll */ regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_BYPASS, VID_PLL_BYPASS); else { /* Disable Bypass */ regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_BYPASS, 0); /* Clear sel */ regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, 3 << 16, 0); regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_PRESET, 0); regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, 0x7fff, 0); /* Setup sel and val */ regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, 3 << 16, shift_sel << 16); regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_PRESET, VID_PLL_PRESET); regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, 0x7fff, shift_val); regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_PRESET, 0); } /* Enable the vid_pll output clock */ regmap_update_bits(priv->hhi, HHI_VID_PLL_CLK_DIV, VID_PLL_EN, VID_PLL_EN); }

Contributors

PersonTokensPropCommitsCommitProp
Neil Armstrong377100.00%2100.00%
Total377100.00%2100.00%

/* * Setup VCLK2 for 27MHz, and enable clocks for ENCI and VDAC * * TOFIX: Refactor into table to also handle HDMI frequency and paths */
static void meson_venci_cvbs_clock_config(struct meson_drm *priv) { unsigned int val; /* Setup PLL to output 1.485GHz */ if (meson_vpu_is_compatible(priv, "amlogic,meson-gxbb-vpu")) { regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x5800023d); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00404e00); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x4800023d); } else if (meson_vpu_is_compatible(priv, "amlogic,meson-gxm-vpu") || meson_vpu_is_compatible(priv, "amlogic,meson-gxl-vpu")) { regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x4000027b); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb300); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0xa6212844); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c4d000c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); /* Reset PLL */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, HDMI_PLL_RESET, HDMI_PLL_RESET); regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, HDMI_PLL_RESET, 0); } /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); /* Disable VCLK2 */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_EN, 0); /* Setup vid_pll to /1 */ meson_vid_pll_set(priv, VID_PLL_DIV_1); /* Setup the VCLK2 divider value to achieve 27MHz */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_DIV, VCLK2_DIV_MASK, (55 - 1)); /* select vid_pll for vclk2 */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_SEL_MASK, (4 << VCLK2_SEL_SHIFT)); /* enable vclk2 gate */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_EN, VCLK2_EN); /* select vclk_div1 for enci */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCI_SEL_MASK, (8 << CTS_ENCI_SEL_SHIFT)); /* select vclk_div1 for vdac */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_DIV, CTS_VDAC_SEL_MASK, (8 << CTS_VDAC_SEL_SHIFT)); /* release vclk2_div_reset and enable vclk2_div */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_DIV, VCLK2_DIV_EN | VCLK2_DIV_RESET, VCLK2_DIV_EN); /* enable vclk2_div1 gate */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_DIV1_EN, VCLK2_DIV1_EN); /* reset vclk2 */ regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_SOFT_RESET, VCLK2_SOFT_RESET); regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_SOFT_RESET, 0); /* enable enci_clk */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL2, CTS_ENCI_EN, CTS_ENCI_EN); /* enable vdac_clk */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL2, CTS_VDAC_EN, CTS_VDAC_EN); }

Contributors

PersonTokensPropCommitsCommitProp
Neil Armstrong431100.00%1100.00%
Total431100.00%1100.00%

/* PLL O1 O2 O3 VP DV EN TX */ /* 4320 /4 /4 /1 /5 /1 => /2 /2 */ #define MESON_VCLK_HDMI_ENCI_54000 1 /* 4320 /4 /4 /1 /5 /1 => /1 /2 */ #define MESON_VCLK_HDMI_DDR_54000 2 /* 2970 /4 /1 /1 /5 /1 => /1 /2 */ #define MESON_VCLK_HDMI_DDR_148500 3 /* 4028 /4 /4 /1 /5 /2 => /1 /1 */ #define MESON_VCLK_HDMI_25175 4 /* 3200 /4 /2 /1 /5 /2 => /1 /1 */ #define MESON_VCLK_HDMI_40000 5 /* 5200 /4 /2 /1 /5 /2 => /1 /1 */ #define MESON_VCLK_HDMI_65000 6 /* 2970 /2 /2 /2 /5 /1 => /1 /1 */ #define MESON_VCLK_HDMI_74250 7 /* 4320 /4 /1 /1 /5 /2 => /1 /1 */ #define MESON_VCLK_HDMI_108000 8 /* 2970 /1 /2 /2 /5 /1 => /1 /1 */ #define MESON_VCLK_HDMI_148500 9 /* 3240 /2 /1 /1 /5 /2 => /1 /1 */ #define MESON_VCLK_HDMI_162000 10 /* 2970 /1 /1 /1 /5 /2 => /1 /1 */ #define MESON_VCLK_HDMI_297000 11 /* 5940 /1 /1 /2 /5 /1 => /1 /1 */ #define MESON_VCLK_HDMI_594000 12 struct meson_vclk_params { unsigned int pll_base_freq; unsigned int pll_od1; unsigned int pll_od2; unsigned int pll_od3; unsigned int vid_pll_div; unsigned int vclk_div; } params[] = { [MESON_VCLK_HDMI_ENCI_54000] = { .pll_base_freq = 4320000, .pll_od1 = 4, .pll_od2 = 4, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 1, }, [MESON_VCLK_HDMI_DDR_54000] = { .pll_base_freq = 4320000, .pll_od1 = 4, .pll_od2 = 4, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 1, }, [MESON_VCLK_HDMI_DDR_148500] = { .pll_base_freq = 2970000, .pll_od1 = 4, .pll_od2 = 1, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 1, }, [MESON_VCLK_HDMI_74250] = { .pll_base_freq = 2970000, .pll_od1 = 2, .pll_od2 = 2, .pll_od3 = 2, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 1, }, [MESON_VCLK_HDMI_148500] = { .pll_base_freq = 2970000, .pll_od1 = 1, .pll_od2 = 2, .pll_od3 = 2, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 1, }, [MESON_VCLK_HDMI_297000] = { .pll_base_freq = 2970000, .pll_od1 = 1, .pll_od2 = 1, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 2, }, [MESON_VCLK_HDMI_594000] = { .pll_base_freq = 5940000, .pll_od1 = 1, .pll_od2 = 1, .pll_od3 = 2, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 1, }, [MESON_VCLK_HDMI_25175] = { .pll_base_freq = 4028000, .pll_od1 = 4, .pll_od2 = 4, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 2, }, [MESON_VCLK_HDMI_40000] = { .pll_base_freq = 3200000, .pll_od1 = 4, .pll_od2 = 2, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 2, }, [MESON_VCLK_HDMI_65000] = { .pll_base_freq = 5200000, .pll_od1 = 4, .pll_od2 = 2, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 2, }, [MESON_VCLK_HDMI_108000] = { .pll_base_freq = 4320000, .pll_od1 = 4, .pll_od2 = 1, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 2, }, [MESON_VCLK_HDMI_162000] = { .pll_base_freq = 3240000, .pll_od1 = 2, .pll_od2 = 1, .pll_od3 = 1, .vid_pll_div = VID_PLL_DIV_5, .vclk_div = 2, }, };
static inline unsigned int pll_od_to_reg(unsigned int od) { switch (od) { case 1: return 0; case 2: return 1; case 4: return 2; case 8: return 3; } /* Invalid */ return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Neil Armstrong46100.00%1100.00%
Total46100.00%1100.00%


void meson_hdmi_pll_set(struct meson_drm *priv, unsigned int base, unsigned int od1, unsigned int od2, unsigned int od3) { unsigned int val; if (meson_vpu_is_compatible(priv, "amlogic,meson-gxbb-vpu")) { switch (base) { case 2970000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x5800023d); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* Enable and unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, 0x7 << 28, 0x4 << 28); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); /* div_frac */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 0xFFFF, 0x4e00); break; case 3200000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x58000242); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); /* div_frac */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 0xFFFF, 0x4aab); break; case 3240000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x58000243); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); /* div_frac */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 0xFFFF, 0x4800); break; case 3865000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x58000250); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); /* div_frac */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 0xFFFF, 0x4855); break; case 4028000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x58000253); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); /* div_frac */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 0xFFFF, 0x4eab); break; case 4320000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x5800025a); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x0d5c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); break; case 5940000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x5800027b); regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 0xFFFF, 0x4c00); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x135c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); break; case 5200000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x5800026c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x00000000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x135c5091); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x801da72c); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x71486980); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x00000e55); /* unreset */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, BIT(28), 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); break; }; } else if (meson_vpu_is_compatible(priv, "amlogic,meson-gxm-vpu") || meson_vpu_is_compatible(priv, "amlogic,meson-gxl-vpu")) { switch (base) { case 2970000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x4000027b); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb300); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 3200000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x40000285); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb155); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 3240000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x40000287); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 3865000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x400002a1); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb02b); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 4028000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x400002a7); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb355); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 4320000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x400002b4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 5940000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x400002f7); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb200); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; case 5200000: regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL, 0x400002d8); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL2, 0x800cb2ab); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL3, 0x860f30c4); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL4, 0x0c8e0000); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL5, 0x001fa729); regmap_write(priv->hhi, HHI_HDMI_PLL_CNTL6, 0x01a31500); break; }; /* Reset PLL */ regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, HDMI_PLL_RESET, HDMI_PLL_RESET); regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL, HDMI_PLL_RESET, 0); /* Poll for lock bit */ regmap_read_poll_timeout(priv->hhi, HHI_HDMI_PLL_CNTL, val, (val & HDMI_PLL_LOCK), 10, 0); }; if (meson_vpu_is_compatible(priv, "amlogic,meson-gxbb-vpu")) regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 3 << 16, pll_od_to_reg(od1) << 16); else if (meson_vpu_is_compatible(priv, "amlogic,meson-gxm-vpu") || meson_vpu_is_compatible(priv, "amlogic,meson-gxl-vpu")) regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL3, 3 << 21, pll_od_to_reg(od1) << 21); if (meson_vpu_is_compatible(priv, "amlogic,meson-gxbb-vpu")) regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 3 << 22, pll_od_to_reg(od2) << 22); else if (meson_vpu_is_compatible(priv, "amlogic,meson-gxm-vpu") || meson_vpu_is_compatible(priv, "amlogic,meson-gxl-vpu")) regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL3, 3 << 23, pll_od_to_reg(od2) << 23); if (meson_vpu_is_compatible(priv, "amlogic,meson-gxbb-vpu")) regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL2, 3 << 18, pll_od_to_reg(od3) << 18); else if (meson_vpu_is_compatible(priv, "amlogic,meson-gxm-vpu") || meson_vpu_is_compatible(priv, "amlogic,meson-gxl-vpu")) regmap_update_bits(priv->hhi, HHI_HDMI_PLL_CNTL3, 3 << 19, pll_od_to_reg(od3) << 19); }

Contributors

PersonTokensPropCommitsCommitProp
Neil Armstrong1827100.00%2100.00%
Total1827100.00%2100.00%


void meson_vclk_setup(struct meson_drm *priv, unsigned int target, unsigned int vclk_freq, unsigned int venc_freq, unsigned int dac_freq, bool hdmi_use_enci) { unsigned int freq; unsigned int hdmi_tx_div; unsigned int venc_div; if (target == MESON_VCLK_TARGET_CVBS) { meson_venci_cvbs_clock_config(priv); return; } hdmi_tx_div = vclk_freq / dac_freq; if (hdmi_tx_div == 0) { pr_err("Fatal Error, invalid HDMI-TX freq %d\n", dac_freq); return; } venc_div = vclk_freq / venc_freq; if (venc_div == 0) { pr_err("Fatal Error, invalid HDMI venc freq %d\n", venc_freq); return; } switch (vclk_freq) { case 54000: if (hdmi_use_enci) freq = MESON_VCLK_HDMI_ENCI_54000; else freq = MESON_VCLK_HDMI_DDR_54000; break; case 25175: freq = MESON_VCLK_HDMI_25175; break; case 40000: freq = MESON_VCLK_HDMI_40000; break; case 65000: freq = MESON_VCLK_HDMI_65000; break; case 74250: freq = MESON_VCLK_HDMI_74250; break; case 108000: freq = MESON_VCLK_HDMI_108000; break; case 148500: if (dac_freq != 148500) freq = MESON_VCLK_HDMI_DDR_148500; else freq = MESON_VCLK_HDMI_148500; break; case 162000: freq = MESON_VCLK_HDMI_162000; break; case 297000: freq = MESON_VCLK_HDMI_297000; break; case 594000: freq = MESON_VCLK_HDMI_594000; break; default: pr_err("Fatal Error, invalid HDMI vclk freq %d\n", vclk_freq); return; } /* Set HDMI-TX sys clock */ regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, CTS_HDMI_SYS_SEL_MASK, 0); regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, CTS_HDMI_SYS_DIV_MASK, 0); regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, CTS_HDMI_SYS_EN, CTS_HDMI_SYS_EN); /* Set HDMI PLL rate */ meson_hdmi_pll_set(priv, params[freq].pll_base_freq, params[freq].pll_od1, params[freq].pll_od2, params[freq].pll_od3); /* Setup vid_pll divider */ meson_vid_pll_set(priv, params[freq].vid_pll_div); /* Set VCLK div */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_SEL_MASK, 0); regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, VCLK_DIV_MASK, params[freq].vclk_div - 1); /* Set HDMI-TX source */ switch (hdmi_tx_div) { case 1: /* enable vclk_div1 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV1_EN, VCLK_DIV1_EN); /* select vclk_div1 for HDMI-TX */ regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, HDMI_TX_PIXEL_SEL_MASK, 0); break; case 2: /* enable vclk_div2 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV2_EN, VCLK_DIV2_EN); /* select vclk_div2 for HDMI-TX */ regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, HDMI_TX_PIXEL_SEL_MASK, 1 << HDMI_TX_PIXEL_SEL_SHIFT); break; case 4: /* enable vclk_div4 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV4_EN, VCLK_DIV4_EN); /* select vclk_div4 for HDMI-TX */ regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, HDMI_TX_PIXEL_SEL_MASK, 2 << HDMI_TX_PIXEL_SEL_SHIFT); break; case 6: /* enable vclk_div6 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV6_EN, VCLK_DIV6_EN); /* select vclk_div6 for HDMI-TX */ regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, HDMI_TX_PIXEL_SEL_MASK, 3 << HDMI_TX_PIXEL_SEL_SHIFT); break; case 12: /* enable vclk_div12 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV12_EN, VCLK_DIV12_EN); /* select vclk_div12 for HDMI-TX */ regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, HDMI_TX_PIXEL_SEL_MASK, 4 << HDMI_TX_PIXEL_SEL_SHIFT); break; } regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL2, HDMI_TX_PIXEL_EN, HDMI_TX_PIXEL_EN); /* Set ENCI/ENCP Source */ switch (venc_div) { case 1: /* enable vclk_div1 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV1_EN, VCLK_DIV1_EN); if (hdmi_use_enci) /* select vclk_div1 for enci */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCI_SEL_MASK, 0); else /* select vclk_div1 for encp */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCP_SEL_MASK, 0); break; case 2: /* enable vclk_div2 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV2_EN, VCLK_DIV2_EN); if (hdmi_use_enci) /* select vclk_div2 for enci */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCI_SEL_MASK, 1 << CTS_ENCI_SEL_SHIFT); else /* select vclk_div2 for encp */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCP_SEL_MASK, 1 << CTS_ENCP_SEL_SHIFT); break; case 4: /* enable vclk_div4 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV4_EN, VCLK_DIV4_EN); if (hdmi_use_enci) /* select vclk_div4 for enci */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCI_SEL_MASK, 2 << CTS_ENCI_SEL_SHIFT); else /* select vclk_div4 for encp */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCP_SEL_MASK, 2 << CTS_ENCP_SEL_SHIFT); break; case 6: /* enable vclk_div6 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV6_EN, VCLK_DIV6_EN); if (hdmi_use_enci) /* select vclk_div6 for enci */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCI_SEL_MASK, 3 << CTS_ENCI_SEL_SHIFT); else /* select vclk_div6 for encp */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCP_SEL_MASK, 3 << CTS_ENCP_SEL_SHIFT); break; case 12: /* enable vclk_div12 gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_DIV12_EN, VCLK_DIV12_EN); if (hdmi_use_enci) /* select vclk_div12 for enci */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCI_SEL_MASK, 4 << CTS_ENCI_SEL_SHIFT); else /* select vclk_div12 for encp */ regmap_update_bits(priv->hhi, HHI_VID_CLK_DIV, CTS_ENCP_SEL_MASK, 4 << CTS_ENCP_SEL_SHIFT); break; } if (hdmi_use_enci) /* Enable ENCI clock gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL2, CTS_ENCI_EN, CTS_ENCI_EN); else /* Enable ENCP clock gate */ regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL2, CTS_ENCP_EN, CTS_ENCP_EN); regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL, VCLK_EN, VCLK_EN); }

Contributors

PersonTokensPropCommitsCommitProp
Neil Armstrong847100.00%3100.00%
Total847100.00%3100.00%

EXPORT_SYMBOL_GPL(meson_vclk_setup);

Overall Contributors

PersonTokensPropCommitsCommitProp
Neil Armstrong4349100.00%4100.00%
Total4349100.00%4100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.