From patchwork Fri Jun 24 20:26:24 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Kevin Brace X-Patchwork-Id: 12895043 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from gabe.freedesktop.org (gabe.freedesktop.org [131.252.210.177]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 7FBCCC433EF for ; Fri, 24 Jun 2022 20:28:57 +0000 (UTC) Received: from gabe.freedesktop.org (localhost [127.0.0.1]) by gabe.freedesktop.org (Postfix) with ESMTP id 467C410F26C; Fri, 24 Jun 2022 20:28:56 +0000 (UTC) Received: from mout.gmx.net (mout.gmx.net [212.227.15.18]) by gabe.freedesktop.org (Postfix) with ESMTPS id 6A03F10F26C for ; Fri, 24 Jun 2022 20:28:55 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=gmx.net; s=badeba3b8450; t=1656102532; bh=5B2DG+yoDk7eNL27AETxkQEHSlS9ljT6DPSAkzlfqEA=; h=X-UI-Sender-Class:From:To:Cc:Subject:Date:In-Reply-To:References; b=dmwAui4N5C9RPu+pjJ19PTAPoxRoApPdSZCzB6RLhAVVo0SVQ1ZbrCOaWbQuAXWEz c4H45r8EASdtACBhXBNWTfJcF92mGdg3oC6/gWJ2v+tDCeAVY6rjv+pDMvlVITR8sx XNMpp7zeHKxJOG35Nhh5IYMuJuo5HeahhfGN8lOo= X-UI-Sender-Class: 01bb95c1-4bf8-414a-932a-4f6e2808ef9c Received: from localhost.localdomain ([174.250.50.5]) by mail.gmx.net (mrgmx004 [212.227.17.184]) with ESMTPSA (Nemesis) id 1N1Obh-1ngasd2LF5-012sdd; Fri, 24 Jun 2022 22:28:52 +0200 From: Kevin Brace To: dri-devel@lists.freedesktop.org Subject: [PATCH 19/28] drm/via: Add via_pll.c Date: Fri, 24 Jun 2022 15:26:24 -0500 Message-Id: <20220624202633.3978-20-kevinbrace@gmx.com> X-Mailer: git-send-email 2.35.1 In-Reply-To: <20220624202633.3978-1-kevinbrace@gmx.com> References: <20220624202633.3978-1-kevinbrace@gmx.com> MIME-Version: 1.0 X-Provags-ID: V03:K1:ps5HuaIKPRJ97+vC2OKYXPbnTqJbCuI1yVGsbdbfk+NLPaB3hb9 cI7N6mCchlmr9fjLcHtnyzIX9bjHDE1ulWTqPFdh0KCOI1fDjApJpoOeEJFodegqJ+YMTRU RHHCAlYEC8eaOAjFsb92Ylwp+d3zAm6/13Ls9BkDbbdHul6JEVUOJncdLV9DkqpVE+B+Ceq oV7gsvaLG7VrBagp6UqxQ== X-UI-Out-Filterresults: notjunk:1;V03:K0:vNxIPjLRB4E=:IQ9ktHFWP7QqR6Zch1f2EV 4E4F25UPBz4xfS1Ya8Ykl+IyKqBqutfM+TVoToeuoLS9Y3qC3TrnBzFuakyoiyn6cZenAZFhO fveWU0QC+KEwLh6C14HIwP9hYQzTSPewz34D3x2phc0Bkn7sW83Nr7LZUCXNLtvqAFtIrBhzy rCWruxwqZJQSOLcu0xkEgUEUoY8rxBrLMlp8H+m/JR8mCqSt+ALln38Nnmydy9khU80dBtNyi z09ljf+husAZr/SOJzMAL+vSCXHgE9KSxR7+WK+aRW3UUML8gSMfRjiTO4F6aSVNbukhsc93s H9WLmWnK3EIXET6teie0TOyUPbOgU5+Vff7BMTmMe96oyp3HmLunWQs8Zm3ifEaBo1RrKmwN6 wV3YCjr+Ai/fyX+s01cQbW0ygi1cnp+6T11TKwB8PRThS9bd3hrT57xd5akvPX4rMRwU0EqVk X+6Vkc8l6R74WuHcvDYSZ/3JZtxdSMCZ/aFoCHIV8cVP+eWQIDnHUsUwIEjLLxAnmy0Ebfo9V 3oAalQnlTpTulZsmHeobAEevR963FOhUF58ahru/UI7hBNgwuFhdkDGGdNiyCpBHPskZCPefq n2JWwjc2mjAei5ouQmTMdk98RA63/ww87j/+kiKsba01dCEj/S5CI71YmueSFH4i8/dQWPD6o PQg50QfsJ4FaOH5lBJtGmIxKVd7Bu9zkskAVuOBJc9NQIsAlZEacYy8JSPkX+sHK18xkol5aE +w3cAxNfV2che1LXVxPgPmhpwBaD57ZqSVuxnbuiCXoVe2dlskUWqnkMT6lr+omlqmus1UPu0 U74lOkmj/eI3xXeZuSSs8TQ4ssf/uwUpD25Pc44UMbDhOWRrPj8umwH5VmS8qPUGjmNGkxAVY qrYXqeiQofbBF281RxGx+SWKsTsY4bpiKTqknulaw3LW5A2raOnJuNQcLoMjnDoqA0R4OSpio rRFXw1dS0m+bjEXoHkh0Plc9vw/re7jy7oIyKkcTRzB/o29gEGQG+DrjjwcS0SNwnLxBZGsF8 M0aFwEZkP3kPTzFcNbPNYPQni4yv+jbQB61f+WIpsCgq2DylV18FiQaA5xjQ7IBUTqNiYEU2B QYOXOvPBcN9L/tlP/6TsLqbfyr/mCeJUmhshfDaTFf06qZElJJ3ypAyjg== X-BeenThere: dri-devel@lists.freedesktop.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: Direct Rendering Infrastructure - Development List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Kevin Brace Errors-To: dri-devel-bounces@lists.freedesktop.org Sender: "dri-devel" From: Kevin Brace Signed-off-by: Kevin Brace --- drivers/gpu/drm/via/via_pll.c | 263 ++++++++++++++++++++++++++++++++++ 1 file changed, 263 insertions(+) create mode 100644 drivers/gpu/drm/via/via_pll.c -- 2.35.1 diff --git a/drivers/gpu/drm/via/via_pll.c b/drivers/gpu/drm/via/via_pll.c new file mode 100644 index 000000000000..ec61d044504d --- /dev/null +++ b/drivers/gpu/drm/via/via_pll.c @@ -0,0 +1,263 @@ +/* + * Copyright 2012 James Simmons. All Rights Reserved. + * Copyright 1998-2009 VIA Technologies, Inc. All Rights Reserved. + * Copyright 2001-2009 S3 Graphics, Inc. All Rights Reserved. + * + * Permission is hereby granted, free of charge, to any person obtaining a + * copy of this software and associated documentation files (the "Software"), + * to deal in the Software without restriction, including without limitation + * the rights to use, copy, modify, merge, publish, distribute, sub license, + * and/or sell copies of the Software, and to permit persons to whom the + * Software is furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice (including the + * next paragraph) shall be included in all copies or substantial portions + * of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL + * THE AUTHOR(S) OR COPYRIGHT HOLDER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR + * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, + * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER + * DEALINGS IN THE SOFTWARE. + * + * Author(s): + * James Simmons + */ + +#include +#include +#include + +#include "via_drv.h" + + +#define CSR_VCO_UP 600000000 +#define CSR_VCO_DOWN 300000000 + +#define PLL_DTZ_DEFAULT (BIT(0) | BIT(1)) + +#define VIA_CLK_REFERENCE 14318180 + +struct pll_mrn_value { + u32 pll_m; + u32 pll_r; + u32 pll_n; + u32 diff_clk; + u32 pll_fout; +}; + +/* + * This function first gets the best frequency M, R, N value + * to program the PLL according to the supplied frequence + * passed in. After we get the MRN values the results are + * formatted to fit properly into the PLL clock registers. + * + * PLL registers M, R, N value + * [31:16] DM[7:0] + * [15:8 ] DR[2:0] + * [7 :0 ] DN[6:0] + */ +u32 via_get_clk_value(struct drm_device *dev, u32 freq) +{ + struct pci_dev *pdev = to_pci_dev(dev->dev); + u32 best_pll_n = 2, best_pll_r = 0, best_pll_m = 2, best_clk_diff = freq; + u32 pll_fout, pll_fvco, pll_mrn = 0; + u32 pll_n, pll_r, pll_m, clk_diff; + struct pll_mrn_value pll_tmp[5] = { + { 0, 0, 0, 0, 0 }, + { 0, 0, 0, 0, 0 }, + { 0, 0, 0, 0, 0 }, + { 0, 0, 0, 0, 0 }, + { 0, 0, 0, 0, 0 } }; + int count; + + if ((pdev->device != PCI_DEVICE_ID_VIA_CLE266) && + (pdev->device != PCI_DEVICE_ID_VIA_KM400)) { + /* DN[6:0] */ + for (pll_n = 2; pll_n < 6; pll_n++) { + /* DR[2:0] */ + for (pll_r = 0; pll_r < 6; pll_r++) { + /* DM[9:0] */ + for (pll_m = 2; pll_m < 512; pll_m++) { + /* first divide pll_n then multiply + * pll_m. We have to reduce pll_m + * to 512 to get rid of the overflow */ + pll_fvco = (VIA_CLK_REFERENCE / pll_n) * pll_m; + if ((pll_fvco >= CSR_VCO_DOWN) && (pll_fvco <= CSR_VCO_UP)) { + pll_fout = pll_fvco >> pll_r; + if (pll_fout < freq) + clk_diff = freq - pll_fout; + else + clk_diff = pll_fout - freq; + + /* if frequency (which is the PLL we want + * to set) > 150MHz, the MRN value we + * write in register must < frequency, and + * get MRN value whose M is the largeset */ + if (freq >= 150000000) { + if ((clk_diff <= pll_tmp[0].diff_clk) || pll_tmp[0].pll_fout == 0) { + for (count = ARRAY_SIZE(pll_tmp) - 1; count >= 1; count--) + pll_tmp[count] = pll_tmp[count - 1]; + + pll_tmp[0].pll_m = pll_m; + pll_tmp[0].pll_r = pll_r; + pll_tmp[0].pll_n = pll_n; + pll_tmp[0].diff_clk = clk_diff; + pll_tmp[0].pll_fout = pll_fout; + } + } + + if (clk_diff < best_clk_diff) { + best_clk_diff = clk_diff; + best_pll_m = pll_m; + best_pll_n = pll_n; + best_pll_r = pll_r; + } + } /* if pll_fvco in VCO range */ + } /* for PLL M */ + } /* for PLL R */ + } /* for PLL N */ + + /* if frequency(which is the PLL we want to set) > 150MHz, + * the MRN value we write in register must < frequency, + * and get MRN value whose M is the largeset */ + if (freq > 150000000) { + best_pll_m = pll_tmp[0].pll_m; + best_pll_r = pll_tmp[0].pll_r; + best_pll_n = pll_tmp[0].pll_n; + } + /* UniChrome IGP (CLE266, KM400(A), KN400, and P4M800 chipsets) + * requires a different formula for calculating the PLL parameters. + * The code was borrowed from OpenChrome DDX device driver UMS + * (User Mode Setting) section, but was modified to not use float type + * variables. */ + } else { + for (pll_r = 0; pll_r < 4; ++pll_r) { + for (pll_n = (pll_r == 0) ? 2 : 1; pll_n <= 7; ++pll_n) { + for (pll_m = 1; pll_m <= 127; ++pll_m) { + pll_fout = VIA_CLK_REFERENCE * pll_m; + pll_fout /= (pll_n << pll_r); + if (pll_fout < freq) + clk_diff = freq - pll_fout; + else + clk_diff = pll_fout - freq; + + if (clk_diff < best_clk_diff) { + best_clk_diff = clk_diff; + best_pll_m = pll_m & 0x7F; + best_pll_n = pll_n & 0x1F; + best_pll_r = pll_r & 0x03; + } + } + } + } + } + + switch (pdev->device) { + case PCI_DEVICE_ID_VIA_CLE266: + case PCI_DEVICE_ID_VIA_KM400: + /* Clock Synthesizer Value 0[7:6]: DR[1:0] + * Clock Synthesizer Value 0[5:0]: DN[5:0] */ + pll_mrn = ((best_pll_r & 0x3) << 14 | + (best_pll_n & 0x1F) << 8); + /* Clock Synthesizer Value 1[6:0]: DM[6:0] */ + pll_mrn |= (best_pll_m & 0x7F); + break; + case PCI_DEVICE_ID_VIA_VX875: + case PCI_DEVICE_ID_VIA_VX900_VGA: + /* Clock Synthesizer Value 0 : DM[7:0] */ + pll_mrn = (best_pll_m & 0xFF) << 16; + /* Clock Synthesizer Value 1[1:0] : DM[9:8] + * Clock Synthesizer Value 1[4:2] : DR[2:0] + * Clock Synthesizer Value 1[7] : DTZ[0] */ + pll_mrn |= (((PLL_DTZ_DEFAULT & 0x1) << 7) | + ((best_pll_r & 0x7) << 2) | + (((best_pll_m) >> 8) & 0x3)) << 8; + /* Clock Synthesizer Value 2[6:0] : DN[6:0] + * Clock Synthesizer Value 2[7] : DTZ[1] */ + pll_mrn |= (((PLL_DTZ_DEFAULT >> 1) & 0x1) << 7) | + ((best_pll_n) & 0x7F); + break; + default: + /* Clock Synthesizer Value 0 : DM[7:0] */ + pll_mrn = ((best_pll_m - 2) & 0xFF) << 16; + /* Clock Synthesizer Value 1[1:0] : DM[9:8] + * Clock Synthesizer Value 1[4:2] : DR[2:0] + * Clock Synthesizer Value 1[7] : DTZ[0] */ + pll_mrn |= (((PLL_DTZ_DEFAULT & 0x1) << 7) | + ((best_pll_r & 0x7) << 2) | + (((best_pll_m - 2) >> 8) & 0x3)) << 8; + /* Clock Synthesizer Value 2[6:0] : DN[6:0] + * Clock Synthesizer Value 2[7] : DTZ[1] */ + pll_mrn |= (((PLL_DTZ_DEFAULT >> 1) & 0x1) << 7) | + ((best_pll_n - 2) & 0x7F); + break; + } + return pll_mrn; +} + +/* Set VCLK */ +void via_set_vclock(struct drm_crtc *crtc, u32 clk) +{ + struct via_crtc *iga = container_of(crtc, struct via_crtc, base); + struct drm_device *dev = crtc->dev; + struct pci_dev *pdev = to_pci_dev(dev->dev); + struct via_drm_priv *dev_priv = to_via_drm_priv(dev); + unsigned long max_loop = 50, i = 0; + + if (!iga->index) { + /* IGA1 HW Reset Enable */ + svga_wcrt_mask(VGABASE, 0x17, 0x00, BIT(7)); + + /* set clk */ + if ((pdev->device == PCI_DEVICE_ID_VIA_CLE266) || + (pdev->device == PCI_DEVICE_ID_VIA_KM400)) { + vga_wseq(VGABASE, 0x46, (clk & 0xFF00) >> 8); /* rshift + divisor */ + vga_wseq(VGABASE, 0x47, (clk & 0x00FF)); /* multiplier */ + } else { + vga_wseq(VGABASE, 0x44, (clk & 0xFF0000) >> 16); + vga_wseq(VGABASE, 0x45, (clk & 0x00FF00) >> 8); + vga_wseq(VGABASE, 0x46, (clk & 0x0000FF)); + } + /* Fire */ + svga_wmisc_mask(VGABASE, BIT(3) | BIT(2), BIT(3) | BIT(2)); + + /* reset pll */ + svga_wseq_mask(VGABASE, 0x40, 0x02, 0x02); + svga_wseq_mask(VGABASE, 0x40, 0x00, 0x02); + + /* exit hw reset */ + while ((vga_rseq(VGABASE, 0x3C) & BIT(3)) == 0 && i++ < max_loop) + udelay(20); + + /* IGA1 HW Reset Disable */ + svga_wcrt_mask(VGABASE, 0x17, BIT(7), BIT(7)); + } else { + /* IGA2 HW Reset Enable */ + svga_wcrt_mask(VGABASE, 0x6A, 0x00, BIT(6)); + + /* set clk */ + if ((pdev->device == PCI_DEVICE_ID_VIA_CLE266) || + (pdev->device == PCI_DEVICE_ID_VIA_KM400)) { + vga_wseq(VGABASE, 0x44, (clk & 0xFF00) >> 8); + vga_wseq(VGABASE, 0x45, (clk & 0x00FF)); + } else { + vga_wseq(VGABASE, 0x4A, (clk & 0xFF0000) >> 16); + vga_wseq(VGABASE, 0x4B, (clk & 0x00FF00) >> 8); + vga_wseq(VGABASE, 0x4C, (clk & 0x0000FF)); + } + + /* reset pll */ + svga_wseq_mask(VGABASE, 0x40, 0x04, 0x04); + svga_wseq_mask(VGABASE, 0x40, 0x00, 0x04); + + /* exit hw reset */ + while ((vga_rseq(VGABASE, 0x3C) & BIT(2)) == 0 && i++ < max_loop) + udelay(20); + + /* IGA2 HW Reset Disble, CR6A[6] = 1 */ + svga_wcrt_mask(VGABASE, 0x6A, BIT(6), BIT(6)); + } +}