1*2874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2f7018c21STomi Valkeinen /*
3f7018c21STomi Valkeinen * drivers/video/geode/video_cs5530.c
4f7018c21STomi Valkeinen * -- CS5530 video device
5f7018c21STomi Valkeinen *
6f7018c21STomi Valkeinen * Copyright (C) 2005 Arcom Control Systems Ltd.
7f7018c21STomi Valkeinen *
8f7018c21STomi Valkeinen * Based on AMD's original 2.4 driver:
9f7018c21STomi Valkeinen * Copyright (C) 2004 Advanced Micro Devices, Inc.
10f7018c21STomi Valkeinen */
11f7018c21STomi Valkeinen #include <linux/fb.h>
12f7018c21STomi Valkeinen #include <linux/delay.h>
13f7018c21STomi Valkeinen #include <asm/io.h>
14f7018c21STomi Valkeinen #include <asm/delay.h>
15f7018c21STomi Valkeinen
16f7018c21STomi Valkeinen #include "geodefb.h"
17f7018c21STomi Valkeinen #include "video_cs5530.h"
18f7018c21STomi Valkeinen
19f7018c21STomi Valkeinen /*
20f7018c21STomi Valkeinen * CS5530 PLL table. This maps pixclocks to the appropriate PLL register
21f7018c21STomi Valkeinen * value.
22f7018c21STomi Valkeinen */
23f7018c21STomi Valkeinen struct cs5530_pll_entry {
24f7018c21STomi Valkeinen long pixclock; /* ps */
25f7018c21STomi Valkeinen u32 pll_value;
26f7018c21STomi Valkeinen };
27f7018c21STomi Valkeinen
28f7018c21STomi Valkeinen static const struct cs5530_pll_entry cs5530_pll_table[] = {
29f7018c21STomi Valkeinen { 39721, 0x31C45801, }, /* 25.1750 MHz */
30f7018c21STomi Valkeinen { 35308, 0x20E36802, }, /* 28.3220 */
31f7018c21STomi Valkeinen { 31746, 0x33915801, }, /* 31.5000 */
32f7018c21STomi Valkeinen { 27777, 0x31EC4801, }, /* 36.0000 */
33f7018c21STomi Valkeinen { 26666, 0x21E22801, }, /* 37.5000 */
34f7018c21STomi Valkeinen { 25000, 0x33088801, }, /* 40.0000 */
35f7018c21STomi Valkeinen { 22271, 0x33E22801, }, /* 44.9000 */
36f7018c21STomi Valkeinen { 20202, 0x336C4801, }, /* 49.5000 */
37f7018c21STomi Valkeinen { 20000, 0x23088801, }, /* 50.0000 */
38f7018c21STomi Valkeinen { 19860, 0x23088801, }, /* 50.3500 */
39f7018c21STomi Valkeinen { 18518, 0x3708A801, }, /* 54.0000 */
40f7018c21STomi Valkeinen { 17777, 0x23E36802, }, /* 56.2500 */
41f7018c21STomi Valkeinen { 17733, 0x23E36802, }, /* 56.3916 */
42f7018c21STomi Valkeinen { 17653, 0x23E36802, }, /* 56.6444 */
43f7018c21STomi Valkeinen { 16949, 0x37C45801, }, /* 59.0000 */
44f7018c21STomi Valkeinen { 15873, 0x23EC4801, }, /* 63.0000 */
45f7018c21STomi Valkeinen { 15384, 0x37911801, }, /* 65.0000 */
46f7018c21STomi Valkeinen { 14814, 0x37963803, }, /* 67.5000 */
47f7018c21STomi Valkeinen { 14124, 0x37058803, }, /* 70.8000 */
48f7018c21STomi Valkeinen { 13888, 0x3710C805, }, /* 72.0000 */
49f7018c21STomi Valkeinen { 13333, 0x37E22801, }, /* 75.0000 */
50f7018c21STomi Valkeinen { 12698, 0x27915801, }, /* 78.7500 */
51f7018c21STomi Valkeinen { 12500, 0x37D8D802, }, /* 80.0000 */
52f7018c21STomi Valkeinen { 11135, 0x27588802, }, /* 89.8000 */
53f7018c21STomi Valkeinen { 10582, 0x27EC4802, }, /* 94.5000 */
54f7018c21STomi Valkeinen { 10101, 0x27AC6803, }, /* 99.0000 */
55f7018c21STomi Valkeinen { 10000, 0x27088801, }, /* 100.0000 */
56f7018c21STomi Valkeinen { 9259, 0x2710C805, }, /* 108.0000 */
57f7018c21STomi Valkeinen { 8888, 0x27E36802, }, /* 112.5000 */
58f7018c21STomi Valkeinen { 7692, 0x27C58803, }, /* 130.0000 */
59f7018c21STomi Valkeinen { 7407, 0x27316803, }, /* 135.0000 */
60f7018c21STomi Valkeinen { 6349, 0x2F915801, }, /* 157.5000 */
61f7018c21STomi Valkeinen { 6172, 0x2F08A801, }, /* 162.0000 */
62f7018c21STomi Valkeinen { 5714, 0x2FB11802, }, /* 175.0000 */
63f7018c21STomi Valkeinen { 5291, 0x2FEC4802, }, /* 189.0000 */
64f7018c21STomi Valkeinen { 4950, 0x2F963803, }, /* 202.0000 */
65f7018c21STomi Valkeinen { 4310, 0x2FB1B802, }, /* 232.0000 */
66f7018c21STomi Valkeinen };
67f7018c21STomi Valkeinen
cs5530_set_dclk_frequency(struct fb_info * info)68f7018c21STomi Valkeinen static void cs5530_set_dclk_frequency(struct fb_info *info)
69f7018c21STomi Valkeinen {
70f7018c21STomi Valkeinen struct geodefb_par *par = info->par;
71f7018c21STomi Valkeinen int i;
72f7018c21STomi Valkeinen u32 value;
73f7018c21STomi Valkeinen long min, diff;
74f7018c21STomi Valkeinen
75f7018c21STomi Valkeinen /* Search the table for the closest pixclock. */
76f7018c21STomi Valkeinen value = cs5530_pll_table[0].pll_value;
77f7018c21STomi Valkeinen min = cs5530_pll_table[0].pixclock - info->var.pixclock;
78f7018c21STomi Valkeinen if (min < 0) min = -min;
79f7018c21STomi Valkeinen for (i = 1; i < ARRAY_SIZE(cs5530_pll_table); i++) {
80f7018c21STomi Valkeinen diff = cs5530_pll_table[i].pixclock - info->var.pixclock;
81f7018c21STomi Valkeinen if (diff < 0L) diff = -diff;
82f7018c21STomi Valkeinen if (diff < min) {
83f7018c21STomi Valkeinen min = diff;
84f7018c21STomi Valkeinen value = cs5530_pll_table[i].pll_value;
85f7018c21STomi Valkeinen }
86f7018c21STomi Valkeinen }
87f7018c21STomi Valkeinen
88f7018c21STomi Valkeinen writel(value, par->vid_regs + CS5530_DOT_CLK_CONFIG);
89f7018c21STomi Valkeinen writel(value | 0x80000100, par->vid_regs + CS5530_DOT_CLK_CONFIG); /* set reset and bypass */
90f7018c21STomi Valkeinen udelay(500); /* wait for PLL to settle */
91f7018c21STomi Valkeinen writel(value & 0x7FFFFFFF, par->vid_regs + CS5530_DOT_CLK_CONFIG); /* clear reset */
92f7018c21STomi Valkeinen writel(value & 0x7FFFFEFF, par->vid_regs + CS5530_DOT_CLK_CONFIG); /* clear bypass */
93f7018c21STomi Valkeinen }
94f7018c21STomi Valkeinen
cs5530_configure_display(struct fb_info * info)95f7018c21STomi Valkeinen static void cs5530_configure_display(struct fb_info *info)
96f7018c21STomi Valkeinen {
97f7018c21STomi Valkeinen struct geodefb_par *par = info->par;
98f7018c21STomi Valkeinen u32 dcfg;
99f7018c21STomi Valkeinen
100f7018c21STomi Valkeinen dcfg = readl(par->vid_regs + CS5530_DISPLAY_CONFIG);
101f7018c21STomi Valkeinen
102f7018c21STomi Valkeinen /* Clear bits from existing mode. */
103f7018c21STomi Valkeinen dcfg &= ~(CS5530_DCFG_CRT_SYNC_SKW_MASK | CS5530_DCFG_PWR_SEQ_DLY_MASK
104f7018c21STomi Valkeinen | CS5530_DCFG_CRT_HSYNC_POL | CS5530_DCFG_CRT_VSYNC_POL
105f7018c21STomi Valkeinen | CS5530_DCFG_FP_PWR_EN | CS5530_DCFG_FP_DATA_EN
106f7018c21STomi Valkeinen | CS5530_DCFG_DAC_PWR_EN | CS5530_DCFG_VSYNC_EN
107f7018c21STomi Valkeinen | CS5530_DCFG_HSYNC_EN);
108f7018c21STomi Valkeinen
109f7018c21STomi Valkeinen /* Set default sync skew and power sequence delays. */
110f7018c21STomi Valkeinen dcfg |= (CS5530_DCFG_CRT_SYNC_SKW_INIT | CS5530_DCFG_PWR_SEQ_DLY_INIT
111f7018c21STomi Valkeinen | CS5530_DCFG_GV_PAL_BYP);
112f7018c21STomi Valkeinen
113f7018c21STomi Valkeinen /* Enable DACs, hsync and vsync for CRTs */
114f7018c21STomi Valkeinen if (par->enable_crt) {
115f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_DAC_PWR_EN;
116f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_HSYNC_EN | CS5530_DCFG_VSYNC_EN;
117f7018c21STomi Valkeinen }
118f7018c21STomi Valkeinen /* Enable panel power and data if using a flat panel. */
119f7018c21STomi Valkeinen if (par->panel_x > 0) {
120f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_FP_PWR_EN;
121f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_FP_DATA_EN;
122f7018c21STomi Valkeinen }
123f7018c21STomi Valkeinen
124f7018c21STomi Valkeinen /* Sync polarities. */
125f7018c21STomi Valkeinen if (info->var.sync & FB_SYNC_HOR_HIGH_ACT)
126f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_CRT_HSYNC_POL;
127f7018c21STomi Valkeinen if (info->var.sync & FB_SYNC_VERT_HIGH_ACT)
128f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_CRT_VSYNC_POL;
129f7018c21STomi Valkeinen
130f7018c21STomi Valkeinen writel(dcfg, par->vid_regs + CS5530_DISPLAY_CONFIG);
131f7018c21STomi Valkeinen }
132f7018c21STomi Valkeinen
cs5530_blank_display(struct fb_info * info,int blank_mode)133f7018c21STomi Valkeinen static int cs5530_blank_display(struct fb_info *info, int blank_mode)
134f7018c21STomi Valkeinen {
135f7018c21STomi Valkeinen struct geodefb_par *par = info->par;
136f7018c21STomi Valkeinen u32 dcfg;
137f7018c21STomi Valkeinen int blank, hsync, vsync;
138f7018c21STomi Valkeinen
139f7018c21STomi Valkeinen switch (blank_mode) {
140f7018c21STomi Valkeinen case FB_BLANK_UNBLANK:
141f7018c21STomi Valkeinen blank = 0; hsync = 1; vsync = 1;
142f7018c21STomi Valkeinen break;
143f7018c21STomi Valkeinen case FB_BLANK_NORMAL:
144f7018c21STomi Valkeinen blank = 1; hsync = 1; vsync = 1;
145f7018c21STomi Valkeinen break;
146f7018c21STomi Valkeinen case FB_BLANK_VSYNC_SUSPEND:
147f7018c21STomi Valkeinen blank = 1; hsync = 1; vsync = 0;
148f7018c21STomi Valkeinen break;
149f7018c21STomi Valkeinen case FB_BLANK_HSYNC_SUSPEND:
150f7018c21STomi Valkeinen blank = 1; hsync = 0; vsync = 1;
151f7018c21STomi Valkeinen break;
152f7018c21STomi Valkeinen case FB_BLANK_POWERDOWN:
153f7018c21STomi Valkeinen blank = 1; hsync = 0; vsync = 0;
154f7018c21STomi Valkeinen break;
155f7018c21STomi Valkeinen default:
156f7018c21STomi Valkeinen return -EINVAL;
157f7018c21STomi Valkeinen }
158f7018c21STomi Valkeinen
159f7018c21STomi Valkeinen dcfg = readl(par->vid_regs + CS5530_DISPLAY_CONFIG);
160f7018c21STomi Valkeinen
161f7018c21STomi Valkeinen dcfg &= ~(CS5530_DCFG_DAC_BL_EN | CS5530_DCFG_DAC_PWR_EN
162f7018c21STomi Valkeinen | CS5530_DCFG_HSYNC_EN | CS5530_DCFG_VSYNC_EN
163f7018c21STomi Valkeinen | CS5530_DCFG_FP_DATA_EN | CS5530_DCFG_FP_PWR_EN);
164f7018c21STomi Valkeinen
165f7018c21STomi Valkeinen if (par->enable_crt) {
166f7018c21STomi Valkeinen if (!blank)
167f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_DAC_BL_EN | CS5530_DCFG_DAC_PWR_EN;
168f7018c21STomi Valkeinen if (hsync)
169f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_HSYNC_EN;
170f7018c21STomi Valkeinen if (vsync)
171f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_VSYNC_EN;
172f7018c21STomi Valkeinen }
173f7018c21STomi Valkeinen if (par->panel_x > 0) {
174f7018c21STomi Valkeinen if (!blank)
175f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_FP_DATA_EN;
176f7018c21STomi Valkeinen if (hsync && vsync)
177f7018c21STomi Valkeinen dcfg |= CS5530_DCFG_FP_PWR_EN;
178f7018c21STomi Valkeinen }
179f7018c21STomi Valkeinen
180f7018c21STomi Valkeinen writel(dcfg, par->vid_regs + CS5530_DISPLAY_CONFIG);
181f7018c21STomi Valkeinen
182f7018c21STomi Valkeinen return 0;
183f7018c21STomi Valkeinen }
184f7018c21STomi Valkeinen
18516379ad8SJulia Lawall const struct geode_vid_ops cs5530_vid_ops = {
186f7018c21STomi Valkeinen .set_dclk = cs5530_set_dclk_frequency,
187f7018c21STomi Valkeinen .configure_display = cs5530_configure_display,
188f7018c21STomi Valkeinen .blank_display = cs5530_blank_display,
189f7018c21STomi Valkeinen };
190