• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /asuswrt-rt-n18u-9.0.0.4.380.2695/release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/video/
1/*
2 *	linux/drivers/video/pmag-ba-fb.c
3 *
4 *	PMAG-BA TURBOchannel Color Frame Buffer (CFB) card support,
5 *	derived from:
6 *	"HP300 Topcat framebuffer support (derived from macfb of all things)
7 *	Phil Blundell <philb@gnu.org> 1998", the original code can be
8 *	found in the file hpfb.c in the same directory.
9 *
10 *	Based on digital document:
11 * 	"PMAG-BA TURBOchannel Color Frame Buffer
12 *	 Functional Specification", Revision 1.2, August 27, 1990
13 *
14 *	DECstation related code Copyright (C) 1999, 2000, 2001 by
15 *	Michael Engel <engel@unix-ag.org>,
16 *	Karsten Merker <merker@linuxtag.org> and
17 *	Harald Koerfgen.
18 *	Copyright (c) 2005, 2006  Maciej W. Rozycki
19 *	Copyright (c) 2005  James Simmons
20 *
21 *	This file is subject to the terms and conditions of the GNU General
22 *	Public License.  See the file COPYING in the main directory of this
23 *	archive for more details.
24 */
25
26#include <linux/compiler.h>
27#include <linux/errno.h>
28#include <linux/fb.h>
29#include <linux/init.h>
30#include <linux/kernel.h>
31#include <linux/module.h>
32#include <linux/tc.h>
33#include <linux/types.h>
34
35#include <asm/io.h>
36#include <asm/system.h>
37
38#include <video/pmag-ba-fb.h>
39
40
41struct pmagbafb_par {
42	volatile void __iomem *mmio;
43	volatile u32 __iomem *dac;
44};
45
46
47static struct fb_var_screeninfo pmagbafb_defined __devinitdata = {
48	.xres		= 1024,
49	.yres		= 864,
50	.xres_virtual	= 1024,
51	.yres_virtual	= 864,
52	.bits_per_pixel	= 8,
53	.red.length	= 8,
54	.green.length	= 8,
55	.blue.length	= 8,
56	.activate	= FB_ACTIVATE_NOW,
57	.height		= -1,
58	.width		= -1,
59	.accel_flags	= FB_ACCEL_NONE,
60	.pixclock	= 14452,
61	.left_margin	= 116,
62	.right_margin	= 12,
63	.upper_margin	= 34,
64	.lower_margin	= 12,
65	.hsync_len	= 128,
66	.vsync_len	= 3,
67	.sync		= FB_SYNC_ON_GREEN,
68	.vmode		= FB_VMODE_NONINTERLACED,
69};
70
71static struct fb_fix_screeninfo pmagbafb_fix __devinitdata = {
72	.id		= "PMAG-BA",
73	.smem_len	= (1024 * 1024),
74	.type		= FB_TYPE_PACKED_PIXELS,
75	.visual		= FB_VISUAL_PSEUDOCOLOR,
76	.line_length	= 1024,
77	.mmio_len	= PMAG_BA_SIZE - PMAG_BA_BT459,
78};
79
80
81static inline void dac_write(struct pmagbafb_par *par, unsigned int reg, u8 v)
82{
83	writeb(v, par->dac + reg / 4);
84}
85
86static inline u8 dac_read(struct pmagbafb_par *par, unsigned int reg)
87{
88	return readb(par->dac + reg / 4);
89}
90
91
92/*
93 * Set the palette.
94 */
95static int pmagbafb_setcolreg(unsigned int regno, unsigned int red,
96			      unsigned int green, unsigned int blue,
97			      unsigned int transp, struct fb_info *info)
98{
99	struct pmagbafb_par *par = info->par;
100
101	if (regno >= info->cmap.len)
102		return 1;
103
104	red   >>= 8;	/* The cmap fields are 16 bits    */
105	green >>= 8;	/* wide, but the hardware colormap */
106	blue  >>= 8;	/* registers are only 8 bits wide */
107
108	mb();
109	dac_write(par, BT459_ADDR_LO, regno);
110	dac_write(par, BT459_ADDR_HI, 0x00);
111	wmb();
112	dac_write(par, BT459_CMAP, red);
113	wmb();
114	dac_write(par, BT459_CMAP, green);
115	wmb();
116	dac_write(par, BT459_CMAP, blue);
117
118	return 0;
119}
120
121static struct fb_ops pmagbafb_ops = {
122	.owner		= THIS_MODULE,
123	.fb_setcolreg	= pmagbafb_setcolreg,
124	.fb_fillrect	= cfb_fillrect,
125	.fb_copyarea	= cfb_copyarea,
126	.fb_imageblit	= cfb_imageblit,
127};
128
129
130/*
131 * Turn the hardware cursor off.
132 */
133static void __init pmagbafb_erase_cursor(struct fb_info *info)
134{
135	struct pmagbafb_par *par = info->par;
136
137	mb();
138	dac_write(par, BT459_ADDR_LO, 0x00);
139	dac_write(par, BT459_ADDR_HI, 0x03);
140	wmb();
141	dac_write(par, BT459_DATA, 0x00);
142}
143
144
145static int __devinit pmagbafb_probe(struct device *dev)
146{
147	struct tc_dev *tdev = to_tc_dev(dev);
148	resource_size_t start, len;
149	struct fb_info *info;
150	struct pmagbafb_par *par;
151	int err;
152
153	info = framebuffer_alloc(sizeof(struct pmagbafb_par), dev);
154	if (!info) {
155		printk(KERN_ERR "%s: Cannot allocate memory\n", dev_name(dev));
156		return -ENOMEM;
157	}
158
159	par = info->par;
160	dev_set_drvdata(dev, info);
161
162	if (fb_alloc_cmap(&info->cmap, 256, 0) < 0) {
163		printk(KERN_ERR "%s: Cannot allocate color map\n",
164		       dev_name(dev));
165		err = -ENOMEM;
166		goto err_alloc;
167	}
168
169	info->fbops = &pmagbafb_ops;
170	info->fix = pmagbafb_fix;
171	info->var = pmagbafb_defined;
172	info->flags = FBINFO_DEFAULT;
173
174	/* Request the I/O MEM resource.  */
175	start = tdev->resource.start;
176	len = tdev->resource.end - start + 1;
177	if (!request_mem_region(start, len, dev_name(dev))) {
178		printk(KERN_ERR "%s: Cannot reserve FB region\n",
179		       dev_name(dev));
180		err = -EBUSY;
181		goto err_cmap;
182	}
183
184	/* MMIO mapping setup.  */
185	info->fix.mmio_start = start;
186	par->mmio = ioremap_nocache(info->fix.mmio_start, info->fix.mmio_len);
187	if (!par->mmio) {
188		printk(KERN_ERR "%s: Cannot map MMIO\n", dev_name(dev));
189		err = -ENOMEM;
190		goto err_resource;
191	}
192	par->dac = par->mmio + PMAG_BA_BT459;
193
194	/* Frame buffer mapping setup.  */
195	info->fix.smem_start = start + PMAG_BA_FBMEM;
196	info->screen_base = ioremap_nocache(info->fix.smem_start,
197					    info->fix.smem_len);
198	if (!info->screen_base) {
199		printk(KERN_ERR "%s: Cannot map FB\n", dev_name(dev));
200		err = -ENOMEM;
201		goto err_mmio_map;
202	}
203	info->screen_size = info->fix.smem_len;
204
205	pmagbafb_erase_cursor(info);
206
207	err = register_framebuffer(info);
208	if (err < 0) {
209		printk(KERN_ERR "%s: Cannot register framebuffer\n",
210		       dev_name(dev));
211		goto err_smem_map;
212	}
213
214	get_device(dev);
215
216	pr_info("fb%d: %s frame buffer device at %s\n",
217		info->node, info->fix.id, dev_name(dev));
218
219	return 0;
220
221
222err_smem_map:
223	iounmap(info->screen_base);
224
225err_mmio_map:
226	iounmap(par->mmio);
227
228err_resource:
229	release_mem_region(start, len);
230
231err_cmap:
232	fb_dealloc_cmap(&info->cmap);
233
234err_alloc:
235	framebuffer_release(info);
236	return err;
237}
238
239static int __exit pmagbafb_remove(struct device *dev)
240{
241	struct tc_dev *tdev = to_tc_dev(dev);
242	struct fb_info *info = dev_get_drvdata(dev);
243	struct pmagbafb_par *par = info->par;
244	resource_size_t start, len;
245
246	put_device(dev);
247	unregister_framebuffer(info);
248	iounmap(info->screen_base);
249	iounmap(par->mmio);
250	start = tdev->resource.start;
251	len = tdev->resource.end - start + 1;
252	release_mem_region(start, len);
253	fb_dealloc_cmap(&info->cmap);
254	framebuffer_release(info);
255	return 0;
256}
257
258
259/*
260 * Initialize the framebuffer.
261 */
262static const struct tc_device_id pmagbafb_tc_table[] = {
263	{ "DEC     ", "PMAG-BA " },
264	{ }
265};
266MODULE_DEVICE_TABLE(tc, pmagbafb_tc_table);
267
268static struct tc_driver pmagbafb_driver = {
269	.id_table	= pmagbafb_tc_table,
270	.driver		= {
271		.name	= "pmagbafb",
272		.bus	= &tc_bus_type,
273		.probe	= pmagbafb_probe,
274		.remove	= __exit_p(pmagbafb_remove),
275	},
276};
277
278static int __init pmagbafb_init(void)
279{
280#ifndef MODULE
281	if (fb_get_options("pmagbafb", NULL))
282		return -ENXIO;
283#endif
284	return tc_register_driver(&pmagbafb_driver);
285}
286
287static void __exit pmagbafb_exit(void)
288{
289	tc_unregister_driver(&pmagbafb_driver);
290}
291
292
293module_init(pmagbafb_init);
294module_exit(pmagbafb_exit);
295
296MODULE_LICENSE("GPL");
297