xref: /openbmc/linux/drivers/video/fbdev/platinumfb.c (revision c900529f3d9161bfde5cca0754f83b4d3c3e0220)
1f7018c21STomi Valkeinen /*
2f7018c21STomi Valkeinen  *  platinumfb.c -- frame buffer device for the PowerMac 'platinum' display
3f7018c21STomi Valkeinen  *
4f7018c21STomi Valkeinen  *  Copyright (C) 1998 Franz Sirl
5f7018c21STomi Valkeinen  *
6f7018c21STomi Valkeinen  *  Frame buffer structure from:
7f7018c21STomi Valkeinen  *    drivers/video/controlfb.c -- frame buffer device for
8f7018c21STomi Valkeinen  *    Apple 'control' display chip.
9f7018c21STomi Valkeinen  *    Copyright (C) 1998 Dan Jacobowitz
10f7018c21STomi Valkeinen  *
11f7018c21STomi Valkeinen  *  Hardware information from:
12f7018c21STomi Valkeinen  *    platinum.c: Console support for PowerMac "platinum" display adaptor.
13f7018c21STomi Valkeinen  *    Copyright (C) 1996 Paul Mackerras and Mark Abene
14f7018c21STomi Valkeinen  *
15f7018c21STomi Valkeinen  *  This file is subject to the terms and conditions of the GNU General Public
16f7018c21STomi Valkeinen  *  License. See the file COPYING in the main directory of this archive for
17f7018c21STomi Valkeinen  *  more details.
18f7018c21STomi Valkeinen  */
19f7018c21STomi Valkeinen 
20f7018c21STomi Valkeinen #undef DEBUG
21f7018c21STomi Valkeinen 
22f7018c21STomi Valkeinen #include <linux/module.h>
23f7018c21STomi Valkeinen #include <linux/kernel.h>
24f7018c21STomi Valkeinen #include <linux/errno.h>
25f7018c21STomi Valkeinen #include <linux/string.h>
26f7018c21STomi Valkeinen #include <linux/mm.h>
27f7018c21STomi Valkeinen #include <linux/vmalloc.h>
28f7018c21STomi Valkeinen #include <linux/delay.h>
29f7018c21STomi Valkeinen #include <linux/interrupt.h>
30f7018c21STomi Valkeinen #include <linux/fb.h>
31f7018c21STomi Valkeinen #include <linux/init.h>
32f7018c21STomi Valkeinen #include <linux/nvram.h>
33e8812acbSRob Herring #include <linux/of.h>
342a8f0934SChristophe Leroy #include <linux/of_address.h>
35e8812acbSRob Herring #include <linux/platform_device.h>
36f7018c21STomi Valkeinen 
37f7018c21STomi Valkeinen #include "macmodes.h"
38f7018c21STomi Valkeinen #include "platinumfb.h"
39f7018c21STomi Valkeinen 
40f7018c21STomi Valkeinen static int default_vmode = VMODE_NVRAM;
41f7018c21STomi Valkeinen static int default_cmode = CMODE_NVRAM;
42f7018c21STomi Valkeinen 
43f7018c21STomi Valkeinen struct fb_info_platinum {
44f7018c21STomi Valkeinen 	struct fb_info			*info;
45f7018c21STomi Valkeinen 
46f7018c21STomi Valkeinen 	int				vmode, cmode;
47f7018c21STomi Valkeinen 	int				xres, yres;
48f7018c21STomi Valkeinen 	int				vxres, vyres;
49f7018c21STomi Valkeinen 	int				xoffset, yoffset;
50f7018c21STomi Valkeinen 
51f7018c21STomi Valkeinen 	struct {
52f7018c21STomi Valkeinen 		__u8 red, green, blue;
53f7018c21STomi Valkeinen 	}				palette[256];
54f7018c21STomi Valkeinen 	u32				pseudo_palette[16];
55f7018c21STomi Valkeinen 
56f7018c21STomi Valkeinen 	volatile struct cmap_regs	__iomem *cmap_regs;
57f7018c21STomi Valkeinen 	unsigned long			cmap_regs_phys;
58f7018c21STomi Valkeinen 
59f7018c21STomi Valkeinen 	volatile struct platinum_regs	__iomem *platinum_regs;
60f7018c21STomi Valkeinen 	unsigned long			platinum_regs_phys;
61f7018c21STomi Valkeinen 
62f7018c21STomi Valkeinen 	__u8				__iomem *frame_buffer;
63f7018c21STomi Valkeinen 	volatile __u8			__iomem *base_frame_buffer;
64f7018c21STomi Valkeinen 	unsigned long			frame_buffer_phys;
65f7018c21STomi Valkeinen 
66f7018c21STomi Valkeinen 	unsigned long			total_vram;
67f7018c21STomi Valkeinen 	int				clktype;
68f7018c21STomi Valkeinen 	int				dactype;
69f7018c21STomi Valkeinen 
70f7018c21STomi Valkeinen 	struct resource			rsrc_fb, rsrc_reg;
71f7018c21STomi Valkeinen };
72f7018c21STomi Valkeinen 
73f7018c21STomi Valkeinen /*
74f7018c21STomi Valkeinen  * Frame buffer device API
75f7018c21STomi Valkeinen  */
76f7018c21STomi Valkeinen 
77f7018c21STomi Valkeinen static int platinumfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
78f7018c21STomi Valkeinen 	u_int transp, struct fb_info *info);
79f7018c21STomi Valkeinen static int platinumfb_blank(int blank_mode, struct fb_info *info);
80f7018c21STomi Valkeinen static int platinumfb_set_par (struct fb_info *info);
81f7018c21STomi Valkeinen static int platinumfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info);
82f7018c21STomi Valkeinen 
83f7018c21STomi Valkeinen /*
84f7018c21STomi Valkeinen  * internal functions
85f7018c21STomi Valkeinen  */
86f7018c21STomi Valkeinen 
87f7018c21STomi Valkeinen static inline int platinum_vram_reqd(int video_mode, int color_mode);
88f7018c21STomi Valkeinen static int read_platinum_sense(struct fb_info_platinum *pinfo);
89f7018c21STomi Valkeinen static void set_platinum_clock(struct fb_info_platinum *pinfo);
90f7018c21STomi Valkeinen static void platinum_set_hardware(struct fb_info_platinum *pinfo);
91f7018c21STomi Valkeinen static int platinum_var_to_par(struct fb_var_screeninfo *var,
92f7018c21STomi Valkeinen 			       struct fb_info_platinum *pinfo,
93f7018c21STomi Valkeinen 			       int check_only);
94f7018c21STomi Valkeinen 
95f7018c21STomi Valkeinen /*
96f7018c21STomi Valkeinen  * Interface used by the world
97f7018c21STomi Valkeinen  */
98f7018c21STomi Valkeinen 
998a48ac33SJani Nikula static const struct fb_ops platinumfb_ops = {
100f7018c21STomi Valkeinen 	.owner =	THIS_MODULE,
101*5a5a31d8SThomas Zimmermann 	FB_DEFAULT_IOMEM_OPS,
102f7018c21STomi Valkeinen 	.fb_check_var	= platinumfb_check_var,
103f7018c21STomi Valkeinen 	.fb_set_par	= platinumfb_set_par,
104f7018c21STomi Valkeinen 	.fb_setcolreg	= platinumfb_setcolreg,
105f7018c21STomi Valkeinen 	.fb_blank	= platinumfb_blank,
106f7018c21STomi Valkeinen };
107f7018c21STomi Valkeinen 
108f7018c21STomi Valkeinen /*
109f7018c21STomi Valkeinen  * Checks a var structure
110f7018c21STomi Valkeinen  */
platinumfb_check_var(struct fb_var_screeninfo * var,struct fb_info * info)111f7018c21STomi Valkeinen static int platinumfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info)
112f7018c21STomi Valkeinen {
113f7018c21STomi Valkeinen 	return platinum_var_to_par(var, info->par, 1);
114f7018c21STomi Valkeinen }
115f7018c21STomi Valkeinen 
116f7018c21STomi Valkeinen /*
117f7018c21STomi Valkeinen  * Applies current var to display
118f7018c21STomi Valkeinen  */
platinumfb_set_par(struct fb_info * info)119f7018c21STomi Valkeinen static int platinumfb_set_par (struct fb_info *info)
120f7018c21STomi Valkeinen {
121f7018c21STomi Valkeinen 	struct fb_info_platinum *pinfo = info->par;
122f7018c21STomi Valkeinen 	struct platinum_regvals *init;
123f7018c21STomi Valkeinen 	int err, offset = 0x20;
124f7018c21STomi Valkeinen 
125f7018c21STomi Valkeinen 	if((err = platinum_var_to_par(&info->var, pinfo, 0))) {
126f7018c21STomi Valkeinen 		printk (KERN_ERR "platinumfb_set_par: error calling"
127f7018c21STomi Valkeinen 				 " platinum_var_to_par: %d.\n", err);
128f7018c21STomi Valkeinen 		return err;
129f7018c21STomi Valkeinen 	}
130f7018c21STomi Valkeinen 
131f7018c21STomi Valkeinen 	platinum_set_hardware(pinfo);
132f7018c21STomi Valkeinen 
133f7018c21STomi Valkeinen 	init = platinum_reg_init[pinfo->vmode-1];
134f7018c21STomi Valkeinen 
135f7018c21STomi Valkeinen  	if ((pinfo->vmode == VMODE_832_624_75) && (pinfo->cmode > CMODE_8))
136f7018c21STomi Valkeinen   		offset = 0x10;
137f7018c21STomi Valkeinen 
138f7018c21STomi Valkeinen 	info->screen_base = pinfo->frame_buffer + init->fb_offset + offset;
139f7018c21STomi Valkeinen 	mutex_lock(&info->mm_lock);
140f7018c21STomi Valkeinen 	info->fix.smem_start = (pinfo->frame_buffer_phys) + init->fb_offset + offset;
141f7018c21STomi Valkeinen 	mutex_unlock(&info->mm_lock);
142f7018c21STomi Valkeinen 	info->fix.visual = (pinfo->cmode == CMODE_8) ?
143f7018c21STomi Valkeinen 		FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR;
144f7018c21STomi Valkeinen  	info->fix.line_length = vmode_attrs[pinfo->vmode-1].hres * (1<<pinfo->cmode)
145f7018c21STomi Valkeinen 		+ offset;
146f7018c21STomi Valkeinen 	printk("line_length: %x\n", info->fix.line_length);
147f7018c21STomi Valkeinen 	return 0;
148f7018c21STomi Valkeinen }
149f7018c21STomi Valkeinen 
platinumfb_blank(int blank,struct fb_info * fb)150f7018c21STomi Valkeinen static int platinumfb_blank(int blank,  struct fb_info *fb)
151f7018c21STomi Valkeinen {
152f7018c21STomi Valkeinen /*
153f7018c21STomi Valkeinen  *  Blank the screen if blank_mode != 0, else unblank. If blank == NULL
154f7018c21STomi Valkeinen  *  then the caller blanks by setting the CLUT (Color Look Up Table) to all
155f7018c21STomi Valkeinen  *  black. Return 0 if blanking succeeded, != 0 if un-/blanking failed due
156f7018c21STomi Valkeinen  *  to e.g. a video mode which doesn't support it. Implements VESA suspend
157f7018c21STomi Valkeinen  *  and powerdown modes on hardware that supports disabling hsync/vsync:
158f7018c21STomi Valkeinen  *    blank_mode == 2: suspend vsync
159f7018c21STomi Valkeinen  *    blank_mode == 3: suspend hsync
160f7018c21STomi Valkeinen  *    blank_mode == 4: powerdown
161f7018c21STomi Valkeinen  */
162f7018c21STomi Valkeinen /* [danj] I think there's something fishy about those constants... */
163f7018c21STomi Valkeinen /*
164f7018c21STomi Valkeinen 	struct fb_info_platinum *info = (struct fb_info_platinum *) fb;
165f7018c21STomi Valkeinen 	int	ctrl;
166f7018c21STomi Valkeinen 
167f5718726SDavid Gibson 	ctrl = le32_to_cpup(&info->platinum_regs->ctrl.r) | 0x33;
168f7018c21STomi Valkeinen 	if (blank)
169f7018c21STomi Valkeinen 		--blank_mode;
170f7018c21STomi Valkeinen 	if (blank & VESA_VSYNC_SUSPEND)
171f7018c21STomi Valkeinen 		ctrl &= ~3;
172f7018c21STomi Valkeinen 	if (blank & VESA_HSYNC_SUSPEND)
173f7018c21STomi Valkeinen 		ctrl &= ~0x30;
174f7018c21STomi Valkeinen 	out_le32(&info->platinum_regs->ctrl.r, ctrl);
175f7018c21STomi Valkeinen */
176f7018c21STomi Valkeinen /* TODO: Figure out how the heck to powerdown this thing! */
177f7018c21STomi Valkeinen 	return 0;
178f7018c21STomi Valkeinen }
179f7018c21STomi Valkeinen 
platinumfb_setcolreg(u_int regno,u_int red,u_int green,u_int blue,u_int transp,struct fb_info * info)180f7018c21STomi Valkeinen static int platinumfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
181f7018c21STomi Valkeinen 			      u_int transp, struct fb_info *info)
182f7018c21STomi Valkeinen {
183f7018c21STomi Valkeinen 	struct fb_info_platinum *pinfo = info->par;
184f7018c21STomi Valkeinen 	volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs;
185f7018c21STomi Valkeinen 
186f7018c21STomi Valkeinen 	if (regno > 255)
187f7018c21STomi Valkeinen 		return 1;
188f7018c21STomi Valkeinen 
189f7018c21STomi Valkeinen 	red >>= 8;
190f7018c21STomi Valkeinen 	green >>= 8;
191f7018c21STomi Valkeinen 	blue >>= 8;
192f7018c21STomi Valkeinen 
193f7018c21STomi Valkeinen 	pinfo->palette[regno].red = red;
194f7018c21STomi Valkeinen 	pinfo->palette[regno].green = green;
195f7018c21STomi Valkeinen 	pinfo->palette[regno].blue = blue;
196f7018c21STomi Valkeinen 
197f7018c21STomi Valkeinen 	out_8(&cmap_regs->addr, regno);		/* tell clut what addr to fill	*/
198f7018c21STomi Valkeinen 	out_8(&cmap_regs->lut, red);		/* send one color channel at	*/
199f7018c21STomi Valkeinen 	out_8(&cmap_regs->lut, green);		/* a time...			*/
200f7018c21STomi Valkeinen 	out_8(&cmap_regs->lut, blue);
201f7018c21STomi Valkeinen 
202f7018c21STomi Valkeinen 	if (regno < 16) {
203f7018c21STomi Valkeinen 		int i;
204f7018c21STomi Valkeinen 		u32 *pal = info->pseudo_palette;
205f7018c21STomi Valkeinen 		switch (pinfo->cmode) {
206f7018c21STomi Valkeinen 		case CMODE_16:
207f7018c21STomi Valkeinen 			pal[regno] = (regno << 10) | (regno << 5) | regno;
208f7018c21STomi Valkeinen 			break;
209f7018c21STomi Valkeinen 		case CMODE_32:
210f7018c21STomi Valkeinen 			i = (regno << 8) | regno;
211f7018c21STomi Valkeinen 			pal[regno] = (i << 16) | i;
212f7018c21STomi Valkeinen 			break;
213f7018c21STomi Valkeinen 		}
214f7018c21STomi Valkeinen 	}
215f7018c21STomi Valkeinen 
216f7018c21STomi Valkeinen 	return 0;
217f7018c21STomi Valkeinen }
218f7018c21STomi Valkeinen 
platinum_vram_reqd(int video_mode,int color_mode)219f7018c21STomi Valkeinen static inline int platinum_vram_reqd(int video_mode, int color_mode)
220f7018c21STomi Valkeinen {
221f7018c21STomi Valkeinen 	int baseval = vmode_attrs[video_mode-1].hres * (1<<color_mode);
222f7018c21STomi Valkeinen 
223f7018c21STomi Valkeinen 	if ((video_mode == VMODE_832_624_75) && (color_mode > CMODE_8))
224f7018c21STomi Valkeinen 		baseval += 0x10;
225f7018c21STomi Valkeinen 	else
226f7018c21STomi Valkeinen 		baseval += 0x20;
227f7018c21STomi Valkeinen 
228f7018c21STomi Valkeinen 	return vmode_attrs[video_mode-1].vres * baseval + 0x1000;
229f7018c21STomi Valkeinen }
230f7018c21STomi Valkeinen 
231f7018c21STomi Valkeinen #define STORE_D2(a, d) { \
232f7018c21STomi Valkeinen 	out_8(&cmap_regs->addr, (a+32)); \
233f7018c21STomi Valkeinen 	out_8(&cmap_regs->d2, (d)); \
234f7018c21STomi Valkeinen }
235f7018c21STomi Valkeinen 
set_platinum_clock(struct fb_info_platinum * pinfo)236f7018c21STomi Valkeinen static void set_platinum_clock(struct fb_info_platinum *pinfo)
237f7018c21STomi Valkeinen {
238f7018c21STomi Valkeinen 	volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs;
239f7018c21STomi Valkeinen 	struct platinum_regvals	*init;
240f7018c21STomi Valkeinen 
241f7018c21STomi Valkeinen 	init = platinum_reg_init[pinfo->vmode-1];
242f7018c21STomi Valkeinen 
243f7018c21STomi Valkeinen 	STORE_D2(6, 0xc6);
244f7018c21STomi Valkeinen 	out_8(&cmap_regs->addr,3+32);
245f7018c21STomi Valkeinen 
246f7018c21STomi Valkeinen 	if (in_8(&cmap_regs->d2) == 2) {
247f7018c21STomi Valkeinen 		STORE_D2(7, init->clock_params[pinfo->clktype][0]);
248f7018c21STomi Valkeinen 		STORE_D2(8, init->clock_params[pinfo->clktype][1]);
249f7018c21STomi Valkeinen 		STORE_D2(3, 3);
250f7018c21STomi Valkeinen 	} else {
251f7018c21STomi Valkeinen 		STORE_D2(4, init->clock_params[pinfo->clktype][0]);
252f7018c21STomi Valkeinen 		STORE_D2(5, init->clock_params[pinfo->clktype][1]);
253f7018c21STomi Valkeinen 		STORE_D2(3, 2);
254f7018c21STomi Valkeinen 	}
255f7018c21STomi Valkeinen 
256f7018c21STomi Valkeinen 	__delay(5000);
257f7018c21STomi Valkeinen 	STORE_D2(9, 0xa6);
258f7018c21STomi Valkeinen }
259f7018c21STomi Valkeinen 
260f7018c21STomi Valkeinen 
261f7018c21STomi Valkeinen /* Now how about actually saying, Make it so! */
262f7018c21STomi Valkeinen /* Some things in here probably don't need to be done each time. */
platinum_set_hardware(struct fb_info_platinum * pinfo)263f7018c21STomi Valkeinen static void platinum_set_hardware(struct fb_info_platinum *pinfo)
264f7018c21STomi Valkeinen {
265f7018c21STomi Valkeinen 	volatile struct platinum_regs	__iomem *platinum_regs = pinfo->platinum_regs;
266f7018c21STomi Valkeinen 	volatile struct cmap_regs	__iomem *cmap_regs = pinfo->cmap_regs;
267f7018c21STomi Valkeinen 	struct platinum_regvals		*init;
268f7018c21STomi Valkeinen 	int				i;
269f7018c21STomi Valkeinen 	int				vmode, cmode;
270f7018c21STomi Valkeinen 
271f7018c21STomi Valkeinen 	vmode = pinfo->vmode;
272f7018c21STomi Valkeinen 	cmode = pinfo->cmode;
273f7018c21STomi Valkeinen 
274f7018c21STomi Valkeinen 	init = platinum_reg_init[vmode - 1];
275f7018c21STomi Valkeinen 
276f7018c21STomi Valkeinen 	/* Initialize display timing registers */
277f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[24].r, 7);	/* turn display off */
278f7018c21STomi Valkeinen 
279f7018c21STomi Valkeinen 	for (i = 0; i < 26; ++i)
280f7018c21STomi Valkeinen 		out_be32(&platinum_regs->reg[i+32].r, init->regs[i]);
281f7018c21STomi Valkeinen 
282f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[26+32].r, (pinfo->total_vram == 0x100000 ?
283f7018c21STomi Valkeinen 						init->offset[cmode] + 4 - cmode :
284f7018c21STomi Valkeinen 						init->offset[cmode]));
285f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[16].r, (unsigned) pinfo->frame_buffer_phys+init->fb_offset+0x10);
286f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[18].r, init->pitch[cmode]);
287f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[19].r, (pinfo->total_vram == 0x100000 ?
288f7018c21STomi Valkeinen 					     init->mode[cmode+1] :
289f7018c21STomi Valkeinen 					     init->mode[cmode]));
290f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[20].r, (pinfo->total_vram == 0x100000 ? 0x11 : 0x1011));
291f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[21].r, 0x100);
292f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[22].r, 1);
293f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[23].r, 1);
294f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[26].r, 0xc00);
295f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[27].r, 0x235);
296f7018c21STomi Valkeinen 	/* out_be32(&platinum_regs->reg[27].r, 0x2aa); */
297f7018c21STomi Valkeinen 
298f7018c21STomi Valkeinen 	STORE_D2(0, (pinfo->total_vram == 0x100000 ?
299f7018c21STomi Valkeinen 		     init->dacula_ctrl[cmode] & 0xf :
300f7018c21STomi Valkeinen 		     init->dacula_ctrl[cmode]));
301f7018c21STomi Valkeinen 	STORE_D2(1, 4);
302f7018c21STomi Valkeinen 	STORE_D2(2, 0);
303f7018c21STomi Valkeinen 
304f7018c21STomi Valkeinen 	set_platinum_clock(pinfo);
305f7018c21STomi Valkeinen 
306f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[24].r, 0);	/* turn display on */
307f7018c21STomi Valkeinen }
308f7018c21STomi Valkeinen 
309f7018c21STomi Valkeinen /*
310f7018c21STomi Valkeinen  * Set misc info vars for this driver
311f7018c21STomi Valkeinen  */
platinum_init_info(struct fb_info * info,struct fb_info_platinum * pinfo)312f7018c21STomi Valkeinen static void platinum_init_info(struct fb_info *info,
313f7018c21STomi Valkeinen 			       struct fb_info_platinum *pinfo)
314f7018c21STomi Valkeinen {
315f7018c21STomi Valkeinen 	/* Fill fb_info */
316f7018c21STomi Valkeinen 	info->fbops = &platinumfb_ops;
317f7018c21STomi Valkeinen 	info->pseudo_palette = pinfo->pseudo_palette;
318f7018c21STomi Valkeinen 	info->screen_base = pinfo->frame_buffer + 0x20;
319f7018c21STomi Valkeinen 
320f7018c21STomi Valkeinen 	fb_alloc_cmap(&info->cmap, 256, 0);
321f7018c21STomi Valkeinen 
322f7018c21STomi Valkeinen 	/* Fill fix common fields */
323f7018c21STomi Valkeinen 	strcpy(info->fix.id, "platinum");
324f7018c21STomi Valkeinen 	info->fix.mmio_start = pinfo->platinum_regs_phys;
325f7018c21STomi Valkeinen 	info->fix.mmio_len = 0x1000;
326f7018c21STomi Valkeinen 	info->fix.type = FB_TYPE_PACKED_PIXELS;
327f7018c21STomi Valkeinen 	info->fix.smem_start = pinfo->frame_buffer_phys + 0x20; /* will be updated later */
328f7018c21STomi Valkeinen 	info->fix.smem_len = pinfo->total_vram - 0x20;
329f7018c21STomi Valkeinen         info->fix.ywrapstep = 0;
330f7018c21STomi Valkeinen 	info->fix.xpanstep = 0;
331f7018c21STomi Valkeinen 	info->fix.ypanstep = 0;
332f7018c21STomi Valkeinen         info->fix.type_aux = 0;
333f7018c21STomi Valkeinen         info->fix.accel = FB_ACCEL_NONE;
334f7018c21STomi Valkeinen }
335f7018c21STomi Valkeinen 
336f7018c21STomi Valkeinen 
platinum_init_fb(struct fb_info * info)337f7018c21STomi Valkeinen static int platinum_init_fb(struct fb_info *info)
338f7018c21STomi Valkeinen {
339f7018c21STomi Valkeinen 	struct fb_info_platinum *pinfo = info->par;
340f7018c21STomi Valkeinen 	struct fb_var_screeninfo var;
341f7018c21STomi Valkeinen 	int sense, rc;
342f7018c21STomi Valkeinen 
343f7018c21STomi Valkeinen 	sense = read_platinum_sense(pinfo);
344f7018c21STomi Valkeinen 	printk(KERN_INFO "platinumfb: Monitor sense value = 0x%x, ", sense);
345066ac5c3SFinn Thain 
346066ac5c3SFinn Thain 	if (IS_REACHABLE(CONFIG_NVRAM) && default_vmode == VMODE_NVRAM)
347f7018c21STomi Valkeinen 		default_vmode = nvram_read_byte(NV_VMODE);
348f7018c21STomi Valkeinen 	if (default_vmode <= 0 || default_vmode > VMODE_MAX ||
349066ac5c3SFinn Thain 	    !platinum_reg_init[default_vmode - 1]) {
350f7018c21STomi Valkeinen 		default_vmode = mac_map_monitor_sense(sense);
351066ac5c3SFinn Thain 		if (!platinum_reg_init[default_vmode - 1])
352f7018c21STomi Valkeinen 			default_vmode = VMODE_640_480_60;
353066ac5c3SFinn Thain 	}
354066ac5c3SFinn Thain 
355066ac5c3SFinn Thain 	if (IS_REACHABLE(CONFIG_NVRAM) && default_cmode == CMODE_NVRAM)
356f7018c21STomi Valkeinen 		default_cmode = nvram_read_byte(NV_CMODE);
357f7018c21STomi Valkeinen 	if (default_cmode < CMODE_8 || default_cmode > CMODE_32)
358f7018c21STomi Valkeinen 		default_cmode = CMODE_8;
359f7018c21STomi Valkeinen 	/*
360f7018c21STomi Valkeinen 	 * Reduce the pixel size if we don't have enough VRAM.
361f7018c21STomi Valkeinen 	 */
362f7018c21STomi Valkeinen 	while(default_cmode > CMODE_8 &&
363f7018c21STomi Valkeinen 	      platinum_vram_reqd(default_vmode, default_cmode) > pinfo->total_vram)
364f7018c21STomi Valkeinen 		default_cmode--;
365f7018c21STomi Valkeinen 
366f7018c21STomi Valkeinen 	printk("platinumfb:  Using video mode %d and color mode %d.\n", default_vmode, default_cmode);
367f7018c21STomi Valkeinen 
368f7018c21STomi Valkeinen 	/* Setup default var */
369f7018c21STomi Valkeinen 	if (mac_vmode_to_var(default_vmode, default_cmode, &var) < 0) {
370f7018c21STomi Valkeinen 		/* This shouldn't happen! */
371f7018c21STomi Valkeinen 		printk("mac_vmode_to_var(%d, %d,) failed\n", default_vmode, default_cmode);
372f7018c21STomi Valkeinen try_again:
373f7018c21STomi Valkeinen 		default_vmode = VMODE_640_480_60;
374f7018c21STomi Valkeinen 		default_cmode = CMODE_8;
375f7018c21STomi Valkeinen 		if (mac_vmode_to_var(default_vmode, default_cmode, &var) < 0) {
376f7018c21STomi Valkeinen 			printk(KERN_ERR "platinumfb: mac_vmode_to_var() failed\n");
377f7018c21STomi Valkeinen 			return -ENXIO;
378f7018c21STomi Valkeinen 		}
379f7018c21STomi Valkeinen 	}
380f7018c21STomi Valkeinen 
381f7018c21STomi Valkeinen 	/* Initialize info structure */
382f7018c21STomi Valkeinen 	platinum_init_info(info, pinfo);
383f7018c21STomi Valkeinen 
384f7018c21STomi Valkeinen 	/* Apply default var */
385f7018c21STomi Valkeinen 	info->var = var;
386f7018c21STomi Valkeinen 	var.activate = FB_ACTIVATE_NOW;
387f7018c21STomi Valkeinen 	rc = fb_set_var(info, &var);
388f7018c21STomi Valkeinen 	if (rc && (default_vmode != VMODE_640_480_60 || default_cmode != CMODE_8))
389f7018c21STomi Valkeinen 		goto try_again;
390f7018c21STomi Valkeinen 
391f7018c21STomi Valkeinen 	/* Register with fbdev layer */
392f7018c21STomi Valkeinen 	rc = register_framebuffer(info);
393f7018c21STomi Valkeinen 	if (rc < 0)
394f7018c21STomi Valkeinen 		return rc;
395f7018c21STomi Valkeinen 
396f7018c21STomi Valkeinen 	fb_info(info, "Apple Platinum frame buffer device\n");
397f7018c21STomi Valkeinen 
398f7018c21STomi Valkeinen 	return 0;
399f7018c21STomi Valkeinen }
400f7018c21STomi Valkeinen 
401f7018c21STomi Valkeinen /*
402f7018c21STomi Valkeinen  * Get the monitor sense value.
403f7018c21STomi Valkeinen  * Note that this can be called before calibrate_delay,
404f7018c21STomi Valkeinen  * so we can't use udelay.
405f7018c21STomi Valkeinen  */
read_platinum_sense(struct fb_info_platinum * info)406f7018c21STomi Valkeinen static int read_platinum_sense(struct fb_info_platinum *info)
407f7018c21STomi Valkeinen {
408f7018c21STomi Valkeinen 	volatile struct platinum_regs __iomem *platinum_regs = info->platinum_regs;
409f7018c21STomi Valkeinen 	int sense;
410f7018c21STomi Valkeinen 
411f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[23].r, 7);	/* turn off drivers */
412f7018c21STomi Valkeinen 	__delay(2000);
413f7018c21STomi Valkeinen 	sense = (~in_be32(&platinum_regs->reg[23].r) & 7) << 8;
414f7018c21STomi Valkeinen 
415f7018c21STomi Valkeinen 	/* drive each sense line low in turn and collect the other 2 */
416f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[23].r, 3);	/* drive A low */
417f7018c21STomi Valkeinen 	__delay(2000);
418f7018c21STomi Valkeinen 	sense |= (~in_be32(&platinum_regs->reg[23].r) & 3) << 4;
419f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[23].r, 5);	/* drive B low */
420f7018c21STomi Valkeinen 	__delay(2000);
421f7018c21STomi Valkeinen 	sense |= (~in_be32(&platinum_regs->reg[23].r) & 4) << 1;
422f7018c21STomi Valkeinen 	sense |= (~in_be32(&platinum_regs->reg[23].r) & 1) << 2;
423f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[23].r, 6);	/* drive C low */
424f7018c21STomi Valkeinen 	__delay(2000);
425f7018c21STomi Valkeinen 	sense |= (~in_be32(&platinum_regs->reg[23].r) & 6) >> 1;
426f7018c21STomi Valkeinen 
427f7018c21STomi Valkeinen 	out_be32(&platinum_regs->reg[23].r, 7);	/* turn off drivers */
428f7018c21STomi Valkeinen 
429f7018c21STomi Valkeinen 	return sense;
430f7018c21STomi Valkeinen }
431f7018c21STomi Valkeinen 
432f7018c21STomi Valkeinen /*
433f7018c21STomi Valkeinen  * This routine takes a user-supplied var, and picks the best vmode/cmode from it.
434f7018c21STomi Valkeinen  * It also updates the var structure to the actual mode data obtained
435f7018c21STomi Valkeinen  */
platinum_var_to_par(struct fb_var_screeninfo * var,struct fb_info_platinum * pinfo,int check_only)436f7018c21STomi Valkeinen static int platinum_var_to_par(struct fb_var_screeninfo *var,
437f7018c21STomi Valkeinen 			       struct fb_info_platinum *pinfo,
438f7018c21STomi Valkeinen 			       int check_only)
439f7018c21STomi Valkeinen {
440f7018c21STomi Valkeinen 	int vmode, cmode;
441f7018c21STomi Valkeinen 
442f7018c21STomi Valkeinen 	if (mac_var_to_vmode(var, &vmode, &cmode) != 0) {
443f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: mac_var_to_vmode unsuccessful.\n");
444f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->xres = %d\n", var->xres);
445f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->yres = %d\n", var->yres);
446f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->xres_virtual = %d\n", var->xres_virtual);
447f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->yres_virtual = %d\n", var->yres_virtual);
448f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->bits_per_pixel = %d\n", var->bits_per_pixel);
449f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->pixclock = %d\n", var->pixclock);
450f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par: var->vmode = %d\n", var->vmode);
451f7018c21STomi Valkeinen 		return -EINVAL;
452f7018c21STomi Valkeinen 	}
453f7018c21STomi Valkeinen 
454f7018c21STomi Valkeinen 	if (!platinum_reg_init[vmode-1]) {
455f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par, vmode %d not valid.\n", vmode);
456f7018c21STomi Valkeinen 		return -EINVAL;
457f7018c21STomi Valkeinen 	}
458f7018c21STomi Valkeinen 
459f7018c21STomi Valkeinen 	if (platinum_vram_reqd(vmode, cmode) > pinfo->total_vram) {
460f7018c21STomi Valkeinen 		printk(KERN_ERR "platinum_var_to_par, not enough ram for vmode %d, cmode %d.\n", vmode, cmode);
461f7018c21STomi Valkeinen 		return -EINVAL;
462f7018c21STomi Valkeinen 	}
463f7018c21STomi Valkeinen 
464f7018c21STomi Valkeinen 	if (mac_vmode_to_var(vmode, cmode, var))
465f7018c21STomi Valkeinen 		return -EINVAL;
466f7018c21STomi Valkeinen 
467f7018c21STomi Valkeinen 	if (check_only)
468f7018c21STomi Valkeinen 		return 0;
469f7018c21STomi Valkeinen 
470f7018c21STomi Valkeinen 	pinfo->vmode = vmode;
471f7018c21STomi Valkeinen 	pinfo->cmode = cmode;
472f7018c21STomi Valkeinen 	pinfo->xres = vmode_attrs[vmode-1].hres;
473f7018c21STomi Valkeinen 	pinfo->yres = vmode_attrs[vmode-1].vres;
474f7018c21STomi Valkeinen 	pinfo->xoffset = 0;
475f7018c21STomi Valkeinen 	pinfo->yoffset = 0;
476f7018c21STomi Valkeinen 	pinfo->vxres = pinfo->xres;
477f7018c21STomi Valkeinen 	pinfo->vyres = pinfo->yres;
478f7018c21STomi Valkeinen 
479f7018c21STomi Valkeinen 	return 0;
480f7018c21STomi Valkeinen }
481f7018c21STomi Valkeinen 
482f7018c21STomi Valkeinen 
483f7018c21STomi Valkeinen /*
484f7018c21STomi Valkeinen  * Parse user specified options (`video=platinumfb:')
485f7018c21STomi Valkeinen  */
platinumfb_setup(char * options)486f7018c21STomi Valkeinen static int __init platinumfb_setup(char *options)
487f7018c21STomi Valkeinen {
488f7018c21STomi Valkeinen 	char *this_opt;
489f7018c21STomi Valkeinen 
490f7018c21STomi Valkeinen 	if (!options || !*options)
491f7018c21STomi Valkeinen 		return 0;
492f7018c21STomi Valkeinen 
493f7018c21STomi Valkeinen 	while ((this_opt = strsep(&options, ",")) != NULL) {
494f7018c21STomi Valkeinen 		if (!strncmp(this_opt, "vmode:", 6)) {
495f7018c21STomi Valkeinen 	    		int vmode = simple_strtoul(this_opt+6, NULL, 0);
496f7018c21STomi Valkeinen 			if (vmode > 0 && vmode <= VMODE_MAX)
497f7018c21STomi Valkeinen 				default_vmode = vmode;
498f7018c21STomi Valkeinen 		} else if (!strncmp(this_opt, "cmode:", 6)) {
499f7018c21STomi Valkeinen 			int depth = simple_strtoul(this_opt+6, NULL, 0);
500f7018c21STomi Valkeinen 			switch (depth) {
501f7018c21STomi Valkeinen 			 case 0:
502f7018c21STomi Valkeinen 			 case 8:
503f7018c21STomi Valkeinen 			    default_cmode = CMODE_8;
504f7018c21STomi Valkeinen 			    break;
505f7018c21STomi Valkeinen 			 case 15:
506f7018c21STomi Valkeinen 			 case 16:
507f7018c21STomi Valkeinen 			    default_cmode = CMODE_16;
508f7018c21STomi Valkeinen 			    break;
509f7018c21STomi Valkeinen 			 case 24:
510f7018c21STomi Valkeinen 			 case 32:
511f7018c21STomi Valkeinen 			    default_cmode = CMODE_32;
512f7018c21STomi Valkeinen 			    break;
513f7018c21STomi Valkeinen 			}
514f7018c21STomi Valkeinen 		}
515f7018c21STomi Valkeinen 	}
516f7018c21STomi Valkeinen 	return 0;
517f7018c21STomi Valkeinen }
518f7018c21STomi Valkeinen 
519f7018c21STomi Valkeinen #ifdef __powerpc__
520f7018c21STomi Valkeinen #define invalidate_cache(addr) \
521f7018c21STomi Valkeinen 	asm volatile("eieio; dcbf 0,%1" \
522f7018c21STomi Valkeinen 	: "=m" (*(addr)) : "r" (addr) : "memory");
523f7018c21STomi Valkeinen #else
524f7018c21STomi Valkeinen #define invalidate_cache(addr)
525f7018c21STomi Valkeinen #endif
526f7018c21STomi Valkeinen 
platinumfb_probe(struct platform_device * odev)527f7018c21STomi Valkeinen static int platinumfb_probe(struct platform_device* odev)
528f7018c21STomi Valkeinen {
529f7018c21STomi Valkeinen 	struct device_node	*dp = odev->dev.of_node;
530f7018c21STomi Valkeinen 	struct fb_info		*info;
531f7018c21STomi Valkeinen 	struct fb_info_platinum	*pinfo;
532f7018c21STomi Valkeinen 	volatile __u8		*fbuffer;
533f7018c21STomi Valkeinen 	int			bank0, bank1, bank2, bank3, rc;
534f7018c21STomi Valkeinen 
535f7018c21STomi Valkeinen 	dev_info(&odev->dev, "Found Apple Platinum video hardware\n");
536f7018c21STomi Valkeinen 
537f7018c21STomi Valkeinen 	info = framebuffer_alloc(sizeof(*pinfo), &odev->dev);
5380adcdbcbSBartlomiej Zolnierkiewicz 	if (!info)
539f7018c21STomi Valkeinen 		return -ENOMEM;
5400adcdbcbSBartlomiej Zolnierkiewicz 
541f7018c21STomi Valkeinen 	pinfo = info->par;
542f7018c21STomi Valkeinen 
543f7018c21STomi Valkeinen 	if (of_address_to_resource(dp, 0, &pinfo->rsrc_reg) ||
544f7018c21STomi Valkeinen 	    of_address_to_resource(dp, 1, &pinfo->rsrc_fb)) {
545f7018c21STomi Valkeinen 		dev_err(&odev->dev, "Can't get resources\n");
546f7018c21STomi Valkeinen 		framebuffer_release(info);
547f7018c21STomi Valkeinen 		return -ENXIO;
548f7018c21STomi Valkeinen 	}
549f7018c21STomi Valkeinen 	dev_dbg(&odev->dev, " registers  : 0x%llx...0x%llx\n",
550f7018c21STomi Valkeinen 		(unsigned long long)pinfo->rsrc_reg.start,
551f7018c21STomi Valkeinen 		(unsigned long long)pinfo->rsrc_reg.end);
552f7018c21STomi Valkeinen 	dev_dbg(&odev->dev, " framebuffer: 0x%llx...0x%llx\n",
553f7018c21STomi Valkeinen 		(unsigned long long)pinfo->rsrc_fb.start,
554f7018c21STomi Valkeinen 		(unsigned long long)pinfo->rsrc_fb.end);
555f7018c21STomi Valkeinen 
556f7018c21STomi Valkeinen 	/* Do not try to request register space, they overlap with the
557f7018c21STomi Valkeinen 	 * northbridge and that can fail. Only request framebuffer
558f7018c21STomi Valkeinen 	 */
559f7018c21STomi Valkeinen 	if (!request_mem_region(pinfo->rsrc_fb.start,
560f7018c21STomi Valkeinen 				resource_size(&pinfo->rsrc_fb),
561f7018c21STomi Valkeinen 				"platinumfb framebuffer")) {
562f7018c21STomi Valkeinen 		printk(KERN_ERR "platinumfb: Can't request framebuffer !\n");
563f7018c21STomi Valkeinen 		framebuffer_release(info);
564f7018c21STomi Valkeinen 		return -ENXIO;
565f7018c21STomi Valkeinen 	}
566f7018c21STomi Valkeinen 
567f7018c21STomi Valkeinen 	/* frame buffer - map only 4MB */
568f7018c21STomi Valkeinen 	pinfo->frame_buffer_phys = pinfo->rsrc_fb.start;
569e04e3950SChristophe Leroy 	pinfo->frame_buffer = ioremap_wt(pinfo->rsrc_fb.start, 0x400000);
570f7018c21STomi Valkeinen 	pinfo->base_frame_buffer = pinfo->frame_buffer;
571f7018c21STomi Valkeinen 
572f7018c21STomi Valkeinen 	/* registers */
573f7018c21STomi Valkeinen 	pinfo->platinum_regs_phys = pinfo->rsrc_reg.start;
574f7018c21STomi Valkeinen 	pinfo->platinum_regs = ioremap(pinfo->rsrc_reg.start, 0x1000);
575f7018c21STomi Valkeinen 
576f7018c21STomi Valkeinen 	pinfo->cmap_regs_phys = 0xf301b000;	/* XXX not in prom? */
577f7018c21STomi Valkeinen 	request_mem_region(pinfo->cmap_regs_phys, 0x1000, "platinumfb cmap");
578f7018c21STomi Valkeinen 	pinfo->cmap_regs = ioremap(pinfo->cmap_regs_phys, 0x1000);
579f7018c21STomi Valkeinen 
580f7018c21STomi Valkeinen 	/* Grok total video ram */
581f7018c21STomi Valkeinen 	out_be32(&pinfo->platinum_regs->reg[16].r, (unsigned)pinfo->frame_buffer_phys);
582f7018c21STomi Valkeinen 	out_be32(&pinfo->platinum_regs->reg[20].r, 0x1011);	/* select max vram */
583f7018c21STomi Valkeinen 	out_be32(&pinfo->platinum_regs->reg[24].r, 0);	/* switch in vram */
584f7018c21STomi Valkeinen 
585f7018c21STomi Valkeinen 	fbuffer = pinfo->base_frame_buffer;
586f7018c21STomi Valkeinen 	fbuffer[0x100000] = 0x34;
587f7018c21STomi Valkeinen 	fbuffer[0x100008] = 0x0;
588f7018c21STomi Valkeinen 	invalidate_cache(&fbuffer[0x100000]);
589f7018c21STomi Valkeinen 	fbuffer[0x200000] = 0x56;
590f7018c21STomi Valkeinen 	fbuffer[0x200008] = 0x0;
591f7018c21STomi Valkeinen 	invalidate_cache(&fbuffer[0x200000]);
592f7018c21STomi Valkeinen 	fbuffer[0x300000] = 0x78;
593f7018c21STomi Valkeinen 	fbuffer[0x300008] = 0x0;
594f7018c21STomi Valkeinen 	invalidate_cache(&fbuffer[0x300000]);
595f7018c21STomi Valkeinen 	bank0 = 1; /* builtin 1MB vram, always there */
596f7018c21STomi Valkeinen 	bank1 = fbuffer[0x100000] == 0x34;
597f7018c21STomi Valkeinen 	bank2 = fbuffer[0x200000] == 0x56;
598f7018c21STomi Valkeinen 	bank3 = fbuffer[0x300000] == 0x78;
599f7018c21STomi Valkeinen 	pinfo->total_vram = (bank0 + bank1 + bank2 + bank3) * 0x100000;
600f7018c21STomi Valkeinen 	printk(KERN_INFO "platinumfb: Total VRAM = %dMB (%d%d%d%d)\n",
601f7018c21STomi Valkeinen 	       (unsigned int) (pinfo->total_vram / 1024 / 1024),
602f7018c21STomi Valkeinen 	       bank3, bank2, bank1, bank0);
603f7018c21STomi Valkeinen 
604f7018c21STomi Valkeinen 	/*
605f7018c21STomi Valkeinen 	 * Try to determine whether we have an old or a new DACula.
606f7018c21STomi Valkeinen 	 */
607f7018c21STomi Valkeinen 	out_8(&pinfo->cmap_regs->addr, 0x40);
608f7018c21STomi Valkeinen 	pinfo->dactype = in_8(&pinfo->cmap_regs->d2);
609f7018c21STomi Valkeinen 	switch (pinfo->dactype) {
610f7018c21STomi Valkeinen 	case 0x3c:
611f7018c21STomi Valkeinen 		pinfo->clktype = 1;
612f7018c21STomi Valkeinen 		printk(KERN_INFO "platinumfb: DACula type 0x3c\n");
613f7018c21STomi Valkeinen 		break;
614f7018c21STomi Valkeinen 	case 0x84:
615f7018c21STomi Valkeinen 		pinfo->clktype = 0;
616f7018c21STomi Valkeinen 		printk(KERN_INFO "platinumfb: DACula type 0x84\n");
617f7018c21STomi Valkeinen 		break;
618f7018c21STomi Valkeinen 	default:
619f7018c21STomi Valkeinen 		pinfo->clktype = 0;
620f7018c21STomi Valkeinen 		printk(KERN_INFO "platinumfb: Unknown DACula type: %x\n", pinfo->dactype);
621f7018c21STomi Valkeinen 		break;
622f7018c21STomi Valkeinen 	}
623f7018c21STomi Valkeinen 	dev_set_drvdata(&odev->dev, info);
624f7018c21STomi Valkeinen 
625f7018c21STomi Valkeinen 	rc = platinum_init_fb(info);
626f7018c21STomi Valkeinen 	if (rc != 0) {
627f7018c21STomi Valkeinen 		iounmap(pinfo->frame_buffer);
628f7018c21STomi Valkeinen 		iounmap(pinfo->platinum_regs);
629f7018c21STomi Valkeinen 		iounmap(pinfo->cmap_regs);
630f7018c21STomi Valkeinen 		framebuffer_release(info);
631f7018c21STomi Valkeinen 	}
632f7018c21STomi Valkeinen 
633f7018c21STomi Valkeinen 	return rc;
634f7018c21STomi Valkeinen }
635f7018c21STomi Valkeinen 
platinumfb_remove(struct platform_device * odev)636cc6a0d40SUwe Kleine-König static void platinumfb_remove(struct platform_device* odev)
637f7018c21STomi Valkeinen {
638f7018c21STomi Valkeinen 	struct fb_info		*info = dev_get_drvdata(&odev->dev);
639f7018c21STomi Valkeinen 	struct fb_info_platinum	*pinfo = info->par;
640f7018c21STomi Valkeinen 
641f7018c21STomi Valkeinen         unregister_framebuffer (info);
642f7018c21STomi Valkeinen 
643f7018c21STomi Valkeinen 	/* Unmap frame buffer and registers */
644f7018c21STomi Valkeinen 	iounmap(pinfo->frame_buffer);
645f7018c21STomi Valkeinen 	iounmap(pinfo->platinum_regs);
646f7018c21STomi Valkeinen 	iounmap(pinfo->cmap_regs);
647f7018c21STomi Valkeinen 
648f7018c21STomi Valkeinen 	release_mem_region(pinfo->rsrc_fb.start,
649f7018c21STomi Valkeinen 			   resource_size(&pinfo->rsrc_fb));
650f7018c21STomi Valkeinen 
651f7018c21STomi Valkeinen 	release_mem_region(pinfo->cmap_regs_phys, 0x1000);
652f7018c21STomi Valkeinen 
653f7018c21STomi Valkeinen 	framebuffer_release(info);
654f7018c21STomi Valkeinen }
655f7018c21STomi Valkeinen 
656f7018c21STomi Valkeinen static struct of_device_id platinumfb_match[] =
657f7018c21STomi Valkeinen {
658f7018c21STomi Valkeinen 	{
659f7018c21STomi Valkeinen 	.name 		= "platinum",
660f7018c21STomi Valkeinen 	},
661f7018c21STomi Valkeinen 	{},
662f7018c21STomi Valkeinen };
663f7018c21STomi Valkeinen 
664f7018c21STomi Valkeinen static struct platform_driver platinum_driver =
665f7018c21STomi Valkeinen {
666f7018c21STomi Valkeinen 	.driver = {
667f7018c21STomi Valkeinen 		.name = "platinumfb",
668f7018c21STomi Valkeinen 		.of_match_table = platinumfb_match,
669f7018c21STomi Valkeinen 	},
670f7018c21STomi Valkeinen 	.probe		= platinumfb_probe,
671cc6a0d40SUwe Kleine-König 	.remove_new	= platinumfb_remove,
672f7018c21STomi Valkeinen };
673f7018c21STomi Valkeinen 
platinumfb_init(void)674f7018c21STomi Valkeinen static int __init platinumfb_init(void)
675f7018c21STomi Valkeinen {
676f7018c21STomi Valkeinen #ifndef MODULE
677f7018c21STomi Valkeinen 	char *option = NULL;
678f7018c21STomi Valkeinen 
679f7018c21STomi Valkeinen 	if (fb_get_options("platinumfb", &option))
680f7018c21STomi Valkeinen 		return -ENODEV;
681f7018c21STomi Valkeinen 	platinumfb_setup(option);
682f7018c21STomi Valkeinen #endif
683f7018c21STomi Valkeinen 	platform_driver_register(&platinum_driver);
684f7018c21STomi Valkeinen 
685f7018c21STomi Valkeinen 	return 0;
686f7018c21STomi Valkeinen }
687f7018c21STomi Valkeinen 
platinumfb_exit(void)688f7018c21STomi Valkeinen static void __exit platinumfb_exit(void)
689f7018c21STomi Valkeinen {
690f7018c21STomi Valkeinen 	platform_driver_unregister(&platinum_driver);
691f7018c21STomi Valkeinen }
692f7018c21STomi Valkeinen 
693f7018c21STomi Valkeinen MODULE_LICENSE("GPL");
694f7018c21STomi Valkeinen MODULE_DESCRIPTION("framebuffer driver for Apple Platinum video");
695f7018c21STomi Valkeinen module_init(platinumfb_init);
696f7018c21STomi Valkeinen 
697f7018c21STomi Valkeinen #ifdef MODULE
698f7018c21STomi Valkeinen module_exit(platinumfb_exit);
699f7018c21STomi Valkeinen #endif
700