forked from ~ljy/RK356X_SDK_RELEASE
blame | history | patch | commit | commitdiff
hc
2024-10-09 244b2c5ca8b14627e4a17755e5922221e121c771 
 kernel/drivers/video/fbdev/atmel_lcdfb.c
....@@ -1,5 +1,5 @@
11 /*
2
- *  Driver for AT91/AT32 LCD Controller
2
+ *  Driver for AT91 LCD Controller
33  *
44  *  Copyright (C) 2007 Atmel Corporation
55  *
....@@ -98,86 +98,6 @@
9898 static struct atmel_lcdfb_config at91sam9rl_config = {
9999 	.have_intensity_bit	= true,
100100 };
101
-
102
-static struct atmel_lcdfb_config at32ap_config = {
103
-	.have_hozval		= true,
104
-};
105
-
106
-static const struct platform_device_id atmel_lcdfb_devtypes[] = {
107
-	{
108
-		.name = "at91sam9261-lcdfb",
109
-		.driver_data = (unsigned long)&at91sam9261_config,
110
-	}, {
111
-		.name = "at91sam9263-lcdfb",
112
-		.driver_data = (unsigned long)&at91sam9263_config,
113
-	}, {
114
-		.name = "at91sam9g10-lcdfb",
115
-		.driver_data = (unsigned long)&at91sam9g10_config,
116
-	}, {
117
-		.name = "at91sam9g45-lcdfb",
118
-		.driver_data = (unsigned long)&at91sam9g45_config,
119
-	}, {
120
-		.name = "at91sam9g45es-lcdfb",
121
-		.driver_data = (unsigned long)&at91sam9g45es_config,
122
-	}, {
123
-		.name = "at91sam9rl-lcdfb",
124
-		.driver_data = (unsigned long)&at91sam9rl_config,
125
-	}, {
126
-		.name = "at32ap-lcdfb",
127
-		.driver_data = (unsigned long)&at32ap_config,
128
-	}, {
129
-		/* terminator */
130
-	}
131
-};
132
-MODULE_DEVICE_TABLE(platform, atmel_lcdfb_devtypes);
133
-
134
-static struct atmel_lcdfb_config *
135
-atmel_lcdfb_get_config(struct platform_device *pdev)
136
-{
137
-	unsigned long data;
138
-
139
-	data = platform_get_device_id(pdev)->driver_data;
140
-
141
-	return (struct atmel_lcdfb_config *)data;
142
-}
143
-
144
-#if defined(CONFIG_ARCH_AT91)
145
-#define	ATMEL_LCDFB_FBINFO_DEFAULT	(FBINFO_DEFAULT \
146
-					 | FBINFO_PARTIAL_PAN_OK \
147
-					 | FBINFO_HWACCEL_YPAN)
148
-
149
-static inline void atmel_lcdfb_update_dma2d(struct atmel_lcdfb_info *sinfo,
150
-					struct fb_var_screeninfo *var,
151
-					struct fb_info *info)
152
-{
153
-
154
-}
155
-#elif defined(CONFIG_AVR32)
156
-#define	ATMEL_LCDFB_FBINFO_DEFAULT	(FBINFO_DEFAULT \
157
-					| FBINFO_PARTIAL_PAN_OK \
158
-					| FBINFO_HWACCEL_XPAN \
159
-					| FBINFO_HWACCEL_YPAN)
160
-
161
-static void atmel_lcdfb_update_dma2d(struct atmel_lcdfb_info *sinfo,
162
-				     struct fb_var_screeninfo *var,
163
-				     struct fb_info *info)
164
-{
165
-	u32 dma2dcfg;
166
-	u32 pixeloff;
167
-
168
-	pixeloff = (var->xoffset * info->var.bits_per_pixel) & 0x1f;
169
-
170
-	dma2dcfg = (info->var.xres_virtual - info->var.xres)
171
-		 * info->var.bits_per_pixel / 8;
172
-	dma2dcfg |= pixeloff << ATMEL_LCDC_PIXELOFF_OFFSET;
173
-	lcdc_writel(sinfo, ATMEL_LCDC_DMA2DCFG, dma2dcfg);
174
-
175
-	/* Update configuration */
176
-	lcdc_writel(sinfo, ATMEL_LCDC_DMACON,
177
-		    lcdc_readl(sinfo, ATMEL_LCDC_DMACON)
178
-		    | ATMEL_LCDC_DMAUPDT);
179
-}
180
-#endif
181101 
182102 static u32 contrast_ctr = ATMEL_LCDC_PS_DIV8
183103 		| ATMEL_LCDC_POL_POSITIVE
....@@ -404,8 +324,6 @@
404324 
405325 	/* Set framebuffer DMA base address and pixel offset */
406326 	lcdc_writel(sinfo, ATMEL_LCDC_DMABADDR1, dma_addr);
407
-
408
-	atmel_lcdfb_update_dma2d(sinfo, var, info);
409327 }
410328 
411329 static inline void atmel_lcdfb_free_video_memory(struct atmel_lcdfb_info *sinfo)
....@@ -590,7 +508,7 @@
590508 	case 32:
591509 		var->transp.offset = 24;
592510 		var->transp.length = 8;
593
-		/* fall through */
511
+		fallthrough;
594512 	case 24:
595513 		if (pdata->lcd_wiring_mode == ATMEL_LCDC_WIRING_RGB) {
596514 			/* RGB:888 mode */
....@@ -715,7 +633,7 @@
715633 		case 2: value |= ATMEL_LCDC_PIXELSIZE_2; break;
716634 		case 4: value |= ATMEL_LCDC_PIXELSIZE_4; break;
717635 		case 8: value |= ATMEL_LCDC_PIXELSIZE_8; break;
718
-		case 15: /* fall through */
636
+		case 15: fallthrough;
719637 		case 16: value |= ATMEL_LCDC_PIXELSIZE_16; break;
720638 		case 24: value |= ATMEL_LCDC_PIXELSIZE_24; break;
721639 		case 32: value |= ATMEL_LCDC_PIXELSIZE_32; break;
....@@ -755,7 +673,7 @@
755673 	lcdc_writel(sinfo, ATMEL_LCDC_MVAL, 0);
756674 
757675 	/* Disable all interrupts */
758
-	lcdc_writel(sinfo, ATMEL_LCDC_IDR, ~0UL);
676
+	lcdc_writel(sinfo, ATMEL_LCDC_IDR, ~0U);
759677 	/* Enable FIFO & DMA errors */
760678 	lcdc_writel(sinfo, ATMEL_LCDC_IER, ATMEL_LCDC_UFLWI | ATMEL_LCDC_OWRI | ATMEL_LCDC_MERI);
761679 
....@@ -906,7 +824,7 @@
906824 	return ((blank_mode == FB_BLANK_NORMAL) ? 1 : 0);
907825 }
908826 
909
-static struct fb_ops atmel_lcdfb_ops = {
827
+static const struct fb_ops atmel_lcdfb_ops = {
910828 	.owner		= THIS_MODULE,
911829 	.fb_check_var	= atmel_lcdfb_check_var,
912830 	.fb_set_par	= atmel_lcdfb_set_par,
....@@ -978,7 +896,6 @@
978896 	clk_disable_unprepare(sinfo->lcdc_clk);
979897 }
980898 
981
-#ifdef CONFIG_OF
982899 static const struct of_device_id atmel_lcdfb_dt_ids[] = {
983900 	{ .compatible = "atmel,at91sam9261-lcdc" , .data = &at91sam9261_config, },
984901 	{ .compatible = "atmel,at91sam9263-lcdc" , .data = &at91sam9263_config, },
....@@ -986,7 +903,6 @@
986903 	{ .compatible = "atmel,at91sam9g45-lcdc" , .data = &at91sam9g45_config, },
987904 	{ .compatible = "atmel,at91sam9g45es-lcdc" , .data = &at91sam9g45es_config, },
988905 	{ .compatible = "atmel,at91sam9rl-lcdc" , .data = &at91sam9rl_config, },
989
-	{ .compatible = "atmel,at32ap-lcdc" , .data = &at32ap_config, },
990906 	{ /* sentinel */ }
991907 };
992908 
....@@ -1034,7 +950,7 @@
1034950 	struct fb_videomode fb_vm;
1035951 	struct gpio_desc *gpiod;
1036952 	struct videomode vm;
1037
-	int ret = -ENOENT;
953
+	int ret;
1038954 	int i;
1039955 
1040956 	sinfo->config = (struct atmel_lcdfb_config*)
....@@ -1122,19 +1038,12 @@
11221038 	of_node_put(display_np);
11231039 	return ret;
11241040 }
1125
-#else
1126
-static int atmel_lcdfb_of_init(struct atmel_lcdfb_info *sinfo)
1127
-{
1128
-	return 0;
1129
-}
1130
-#endif
11311041 
11321042 static int __init atmel_lcdfb_probe(struct platform_device *pdev)
11331043 {
11341044 	struct device *dev = &pdev->dev;
11351045 	struct fb_info *info;
11361046 	struct atmel_lcdfb_info *sinfo;
1137
-	struct atmel_lcdfb_pdata *pdata = NULL;
11381047 	struct resource *regs = NULL;
11391048 	struct resource *map = NULL;
11401049 	struct fb_modelist *modelist;
....@@ -1144,10 +1053,8 @@
11441053 
11451054 	ret = -ENOMEM;
11461055 	info = framebuffer_alloc(sizeof(struct atmel_lcdfb_info), dev);
1147
-	if (!info) {
1148
-		dev_err(dev, "cannot allocate memory\n");
1056
+	if (!info)
11491057 		goto out;
1150
-	}
11511058 
11521059 	sinfo = info->par;
11531060 	sinfo->pdev = pdev;
....@@ -1155,30 +1062,16 @@
11551062 
11561063 	INIT_LIST_HEAD(&info->modelist);
11571064 
1158
-	if (pdev->dev.of_node) {
1159
-		ret = atmel_lcdfb_of_init(sinfo);
1160
-		if (ret)
1161
-			goto free_info;
1162
-	} else if (dev_get_platdata(dev)) {
1163
-		struct fb_monspecs *monspecs;
1164
-		int i;
1165
-
1166
-		pdata = dev_get_platdata(dev);
1167
-		monspecs = pdata->default_monspecs;
1168
-		sinfo->pdata = *pdata;
1169
-
1170
-		for (i = 0; i < monspecs->modedb_len; i++)
1171
-			fb_add_videomode(&monspecs->modedb[i], &info->modelist);
1172
-
1173
-		sinfo->config = atmel_lcdfb_get_config(pdev);
1174
-
1175
-		info->var.bits_per_pixel = pdata->default_bpp ? pdata->default_bpp : 16;
1176
-		memcpy(&info->monspecs, pdata->default_monspecs, sizeof(info->monspecs));
1177
-	} else {
1065
+	if (!pdev->dev.of_node) {
11781066 		dev_err(dev, "cannot get default configuration\n");
11791067 		goto free_info;
11801068 	}
11811069 
1070
+	ret = atmel_lcdfb_of_init(sinfo);
1071
+	if (ret)
1072
+		goto free_info;
1073
+
1074
+	ret = -ENODEV;
11821075 	if (!sinfo->config)
11831076 		goto free_info;
11841077 
....@@ -1186,7 +1079,8 @@
11861079 	if (IS_ERR(sinfo->reg_lcd))
11871080 		sinfo->reg_lcd = NULL;
11881081 
1189
-	info->flags = ATMEL_LCDFB_FBINFO_DEFAULT;
1082
+	info->flags = FBINFO_DEFAULT | FBINFO_PARTIAL_PAN_OK |
1083
+		      FBINFO_HWACCEL_YPAN;
11901084 	info->pseudo_palette = sinfo->pseudo_palette;
11911085 	info->fbops = &atmel_lcdfb_ops;
11921086 
....@@ -1221,7 +1115,6 @@
12211115 
12221116 	sinfo->irq_base = platform_get_irq(pdev, 0);
12231117 	if (sinfo->irq_base < 0) {
1224
-		dev_err(dev, "unable to get irq\n");
12251118 		ret = sinfo->irq_base;
12261119 		goto stop_clk;
12271120 	}
....@@ -1357,12 +1250,10 @@
13571250 	struct device *dev = &pdev->dev;
13581251 	struct fb_info *info = dev_get_drvdata(dev);
13591252 	struct atmel_lcdfb_info *sinfo;
1360
-	struct atmel_lcdfb_pdata *pdata;
13611253 
13621254 	if (!info || !info->par)
13631255 		return 0;
13641256 	sinfo = info->par;
1365
-	pdata = &sinfo->pdata;
13661257 
13671258 	cancel_work_sync(&sinfo->task);
13681259 	exit_backlight(sinfo);
....@@ -1398,7 +1289,7 @@
13981289 	 * We don't want to handle interrupts while the clock is
13991290 	 * stopped. It may take forever.
14001291 	 */
1401
-	lcdc_writel(sinfo, ATMEL_LCDC_IDR, ~0UL);
1292
+	lcdc_writel(sinfo, ATMEL_LCDC_IDR, ~0U);
14021293 
14031294 	sinfo->saved_lcdcon = lcdc_readl(sinfo, ATMEL_LCDC_CONTRAST_CTR);
14041295 	lcdc_writel(sinfo, ATMEL_LCDC_CONTRAST_CTR, 0);
....@@ -1435,7 +1326,6 @@
14351326 	.remove		= __exit_p(atmel_lcdfb_remove),
14361327 	.suspend	= atmel_lcdfb_suspend,
14371328 	.resume		= atmel_lcdfb_resume,
1438
-	.id_table	= atmel_lcdfb_devtypes,
14391329 	.driver		= {
14401330 		.name	= "atmel_lcdfb",
14411331 		.of_match_table	= of_match_ptr(atmel_lcdfb_dt_ids),
....@@ -1444,6 +1334,6 @@
14441334 
14451335 module_platform_driver_probe(atmel_lcdfb_driver, atmel_lcdfb_probe);
14461336 
1447
-MODULE_DESCRIPTION("AT91/AT32 LCD Controller framebuffer driver");
1337
+MODULE_DESCRIPTION("AT91 LCD Controller framebuffer driver");
14481338 MODULE_AUTHOR("Nicolas Ferre <nicolas.ferre@atmel.com>");
14491339 MODULE_LICENSE("GPL");