1 #include <linux/device.h>
2 #include <linux/of.h>
3 #include <linux/regmap.h>
4 #include <linux/mfd/syscon.h>
5 #include <linux/bitops.h>
6 #include <linux/module.h>
7 #include <drm/drmP.h>
8 #include "pl111_versatile.h"
9 #include "pl111_drm.h"
10 
11 static struct regmap *versatile_syscon_map;
12 
13 /*
14  * We detect the different syscon types from the compatible strings.
15  */
16 enum versatile_clcd {
17 	INTEGRATOR_CLCD_CM,
18 	VERSATILE_CLCD,
19 	REALVIEW_CLCD_EB,
20 	REALVIEW_CLCD_PB1176,
21 	REALVIEW_CLCD_PB11MP,
22 	REALVIEW_CLCD_PBA8,
23 	REALVIEW_CLCD_PBX,
24 };
25 
26 static const struct of_device_id versatile_clcd_of_match[] = {
27 	{
28 		.compatible = "arm,core-module-integrator",
29 		.data = (void *)INTEGRATOR_CLCD_CM,
30 	},
31 	{
32 		.compatible = "arm,versatile-sysreg",
33 		.data = (void *)VERSATILE_CLCD,
34 	},
35 	{
36 		.compatible = "arm,realview-eb-syscon",
37 		.data = (void *)REALVIEW_CLCD_EB,
38 	},
39 	{
40 		.compatible = "arm,realview-pb1176-syscon",
41 		.data = (void *)REALVIEW_CLCD_PB1176,
42 	},
43 	{
44 		.compatible = "arm,realview-pb11mp-syscon",
45 		.data = (void *)REALVIEW_CLCD_PB11MP,
46 	},
47 	{
48 		.compatible = "arm,realview-pba8-syscon",
49 		.data = (void *)REALVIEW_CLCD_PBA8,
50 	},
51 	{
52 		.compatible = "arm,realview-pbx-syscon",
53 		.data = (void *)REALVIEW_CLCD_PBX,
54 	},
55 	{},
56 };
57 
58 /*
59  * Core module CLCD control on the Integrator/CP, bits
60  * 8 thru 19 of the CM_CONTROL register controls a bunch
61  * of CLCD settings.
62  */
63 #define INTEGRATOR_HDR_CTRL_OFFSET	0x0C
64 #define INTEGRATOR_CLCD_LCDBIASEN	BIT(8)
65 #define INTEGRATOR_CLCD_LCDBIASUP	BIT(9)
66 #define INTEGRATOR_CLCD_LCDBIASDN	BIT(10)
67 /* Bits 11,12,13 controls the LCD type */
68 #define INTEGRATOR_CLCD_LCDMUX_MASK	(BIT(11)|BIT(12)|BIT(13))
69 #define INTEGRATOR_CLCD_LCDMUX_LCD24	BIT(11)
70 #define INTEGRATOR_CLCD_LCDMUX_VGA565	BIT(12)
71 #define INTEGRATOR_CLCD_LCDMUX_SHARP	(BIT(11)|BIT(12))
72 #define INTEGRATOR_CLCD_LCDMUX_VGA555	BIT(13)
73 #define INTEGRATOR_CLCD_LCDMUX_VGA24	(BIT(11)|BIT(12)|BIT(13))
74 #define INTEGRATOR_CLCD_LCD0_EN		BIT(14)
75 #define INTEGRATOR_CLCD_LCD1_EN		BIT(15)
76 /* R/L flip on Sharp */
77 #define INTEGRATOR_CLCD_LCD_STATIC1	BIT(16)
78 /* U/D flip on Sharp */
79 #define INTEGRATOR_CLCD_LCD_STATIC2	BIT(17)
80 /* No connection on Sharp */
81 #define INTEGRATOR_CLCD_LCD_STATIC	BIT(18)
82 /* 0 = 24bit VGA, 1 = 18bit VGA */
83 #define INTEGRATOR_CLCD_LCD_N24BITEN	BIT(19)
84 
85 #define INTEGRATOR_CLCD_MASK		(INTEGRATOR_CLCD_LCDBIASEN | \
86 					 INTEGRATOR_CLCD_LCDBIASUP | \
87 					 INTEGRATOR_CLCD_LCDBIASDN | \
88 					 INTEGRATOR_CLCD_LCDMUX_MASK | \
89 					 INTEGRATOR_CLCD_LCD0_EN | \
90 					 INTEGRATOR_CLCD_LCD1_EN | \
91 					 INTEGRATOR_CLCD_LCD_STATIC1 | \
92 					 INTEGRATOR_CLCD_LCD_STATIC2 | \
93 					 INTEGRATOR_CLCD_LCD_STATIC | \
94 					 INTEGRATOR_CLCD_LCD_N24BITEN)
95 
96 static void pl111_integrator_enable(struct drm_device *drm, u32 format)
97 {
98 	u32 val;
99 
100 	dev_info(drm->dev, "enable Integrator CLCD connectors\n");
101 
102 	/* FIXME: really needed? */
103 	val = INTEGRATOR_CLCD_LCD_STATIC1 | INTEGRATOR_CLCD_LCD_STATIC2 |
104 		INTEGRATOR_CLCD_LCD0_EN | INTEGRATOR_CLCD_LCD1_EN;
105 
106 	switch (format) {
107 	case DRM_FORMAT_XBGR8888:
108 	case DRM_FORMAT_XRGB8888:
109 		break;
110 	case DRM_FORMAT_BGR565:
111 	case DRM_FORMAT_RGB565:
112 		/* truecolor RGB565 */
113 		val |= INTEGRATOR_CLCD_LCDMUX_VGA565;
114 		break;
115 	case DRM_FORMAT_XBGR1555:
116 	case DRM_FORMAT_XRGB1555:
117 		/* Pseudocolor, RGB555, BGR555 */
118 		val |= INTEGRATOR_CLCD_LCDMUX_VGA555;
119 		break;
120 	default:
121 		dev_err(drm->dev, "unhandled format on Integrator 0x%08x\n",
122 			format);
123 		break;
124 	}
125 
126 	regmap_update_bits(versatile_syscon_map,
127 			   INTEGRATOR_HDR_CTRL_OFFSET,
128 			   INTEGRATOR_CLCD_MASK,
129 			   val);
130 }
131 
132 /*
133  * This configuration register in the Versatile and RealView
134  * family is uniformly present but appears more and more
135  * unutilized starting with the RealView series.
136  */
137 #define SYS_CLCD			0x50
138 #define SYS_CLCD_MODE_MASK		(BIT(0)|BIT(1))
139 #define SYS_CLCD_MODE_888		0
140 #define SYS_CLCD_MODE_5551		BIT(0)
141 #define SYS_CLCD_MODE_565_R_LSB		BIT(1)
142 #define SYS_CLCD_MODE_565_B_LSB		(BIT(0)|BIT(1))
143 #define SYS_CLCD_CONNECTOR_MASK		(BIT(2)|BIT(3)|BIT(4)|BIT(5))
144 #define SYS_CLCD_NLCDIOON		BIT(2)
145 #define SYS_CLCD_VDDPOSSWITCH		BIT(3)
146 #define SYS_CLCD_PWR3V5SWITCH		BIT(4)
147 #define SYS_CLCD_VDDNEGSWITCH		BIT(5)
148 
149 static void pl111_versatile_disable(struct drm_device *drm)
150 {
151 	dev_info(drm->dev, "disable Versatile CLCD connectors\n");
152 	regmap_update_bits(versatile_syscon_map,
153 			   SYS_CLCD,
154 			   SYS_CLCD_CONNECTOR_MASK,
155 			   0);
156 }
157 
158 static void pl111_versatile_enable(struct drm_device *drm, u32 format)
159 {
160 	u32 val = 0;
161 
162 	dev_info(drm->dev, "enable Versatile CLCD connectors\n");
163 
164 	switch (format) {
165 	case DRM_FORMAT_ABGR8888:
166 	case DRM_FORMAT_XBGR8888:
167 	case DRM_FORMAT_ARGB8888:
168 	case DRM_FORMAT_XRGB8888:
169 		val |= SYS_CLCD_MODE_888;
170 		break;
171 	case DRM_FORMAT_BGR565:
172 		val |= SYS_CLCD_MODE_565_R_LSB;
173 		break;
174 	case DRM_FORMAT_RGB565:
175 		val |= SYS_CLCD_MODE_565_B_LSB;
176 		break;
177 	case DRM_FORMAT_ABGR1555:
178 	case DRM_FORMAT_XBGR1555:
179 	case DRM_FORMAT_ARGB1555:
180 	case DRM_FORMAT_XRGB1555:
181 		val |= SYS_CLCD_MODE_5551;
182 		break;
183 	default:
184 		dev_err(drm->dev, "unhandled format on Versatile 0x%08x\n",
185 			format);
186 		break;
187 	}
188 
189 	/* Set up the MUX */
190 	regmap_update_bits(versatile_syscon_map,
191 			   SYS_CLCD,
192 			   SYS_CLCD_MODE_MASK,
193 			   val);
194 
195 	/* Then enable the display */
196 	regmap_update_bits(versatile_syscon_map,
197 			   SYS_CLCD,
198 			   SYS_CLCD_CONNECTOR_MASK,
199 			   SYS_CLCD_NLCDIOON | SYS_CLCD_PWR3V5SWITCH);
200 }
201 
202 static void pl111_realview_clcd_disable(struct drm_device *drm)
203 {
204 	dev_info(drm->dev, "disable RealView CLCD connectors\n");
205 	regmap_update_bits(versatile_syscon_map,
206 			   SYS_CLCD,
207 			   SYS_CLCD_CONNECTOR_MASK,
208 			   0);
209 }
210 
211 static void pl111_realview_clcd_enable(struct drm_device *drm, u32 format)
212 {
213 	dev_info(drm->dev, "enable RealView CLCD connectors\n");
214 	regmap_update_bits(versatile_syscon_map,
215 			   SYS_CLCD,
216 			   SYS_CLCD_CONNECTOR_MASK,
217 			   SYS_CLCD_NLCDIOON | SYS_CLCD_PWR3V5SWITCH);
218 }
219 
220 int pl111_versatile_init(struct device *dev, struct pl111_drm_dev_private *priv)
221 {
222 	const struct of_device_id *clcd_id;
223 	enum versatile_clcd versatile_clcd_type;
224 	struct device_node *np;
225 	struct regmap *map;
226 
227 	np = of_find_matching_node_and_match(NULL, versatile_clcd_of_match,
228 					     &clcd_id);
229 	if (!np) {
230 		/* Non-ARM reference designs, just bail out */
231 		return 0;
232 	}
233 	versatile_clcd_type = (enum versatile_clcd)clcd_id->data;
234 
235 	map = syscon_node_to_regmap(np);
236 	if (IS_ERR(map)) {
237 		dev_err(dev, "no Versatile syscon regmap\n");
238 		return PTR_ERR(map);
239 	}
240 
241 	switch (versatile_clcd_type) {
242 	case INTEGRATOR_CLCD_CM:
243 		versatile_syscon_map = map;
244 		priv->variant_display_enable = pl111_integrator_enable;
245 		dev_info(dev, "set up callbacks for Integrator PL110\n");
246 		break;
247 	case VERSATILE_CLCD:
248 		versatile_syscon_map = map;
249 		priv->variant_display_enable = pl111_versatile_enable;
250 		priv->variant_display_disable = pl111_versatile_disable;
251 		dev_info(dev, "set up callbacks for Versatile PL110+\n");
252 		break;
253 	case REALVIEW_CLCD_EB:
254 	case REALVIEW_CLCD_PB1176:
255 	case REALVIEW_CLCD_PB11MP:
256 	case REALVIEW_CLCD_PBA8:
257 	case REALVIEW_CLCD_PBX:
258 		versatile_syscon_map = map;
259 		priv->variant_display_enable = pl111_realview_clcd_enable;
260 		priv->variant_display_disable = pl111_realview_clcd_disable;
261 		dev_info(dev, "set up callbacks for RealView PL111\n");
262 		break;
263 	default:
264 		dev_info(dev, "unknown Versatile system controller\n");
265 		break;
266 	}
267 
268 	return 0;
269 }
270 EXPORT_SYMBOL_GPL(pl111_versatile_init);
271