This source file includes following definitions.
- dnfb_blank
- dnfb_copyarea
- dnfb_probe
- dnfb_init
1
2 #include <linux/kernel.h>
3 #include <linux/errno.h>
4 #include <linux/string.h>
5 #include <linux/mm.h>
6 #include <linux/delay.h>
7 #include <linux/interrupt.h>
8 #include <linux/platform_device.h>
9
10 #include <asm/setup.h>
11 #include <asm/irq.h>
12 #include <asm/amigahw.h>
13 #include <asm/amigaints.h>
14 #include <asm/apollohw.h>
15 #include <linux/fb.h>
16 #include <linux/module.h>
17
18
19
20
21
22
23
24
25
26
27
28
29
30 #define AP_IOBASE 0x3b0
31 #define AP_STATUS isaIO2mem(AP_IOBASE+0)
32 #define AP_WRITE_ENABLE isaIO2mem(AP_IOBASE+0)
33 #define AP_DEVICE_ID isaIO2mem(AP_IOBASE+1)
34 #define AP_ROP_1 isaIO2mem(AP_IOBASE+2)
35 #define AP_DIAG_MEM_REQ isaIO2mem(AP_IOBASE+4)
36 #define AP_CONTROL_0 isaIO2mem(AP_IOBASE+8)
37 #define AP_CONTROL_1 isaIO2mem(AP_IOBASE+0xa)
38 #define AP_CONTROL_3A isaIO2mem(AP_IOBASE+0xe)
39 #define AP_CONTROL_2 isaIO2mem(AP_IOBASE+0xc)
40
41
42 #define FRAME_BUFFER_START 0x0FA0000
43 #define FRAME_BUFFER_LEN 0x40000
44
45
46 #define VECTOR_MODE 0x40
47 #define DBLT_MODE 0x80
48 #define NORMAL_MODE 0xE0
49 #define SHIFT_BITS 0x1F
50
51
52
53 #define AD_BLT 0x80
54 #define NORMAL 0x80
55 #define INVERSE 0x00
56 #define PIX_BLT 0x00
57
58 #define AD_HIBIT 0x40
59
60 #define ROP_EN 0x10
61 #define DST_EQ_SRC 0x00
62 #define nRESET_SYNC 0x08
63 #define SYNC_ENAB 0x02
64
65 #define BLANK_DISP 0x00
66 #define ENAB_DISP 0x01
67
68 #define NORM_CREG1 (nRESET_SYNC | SYNC_ENAB | ENAB_DISP)
69
70
71
72
73
74
75
76 #define S_DATA_1s 0x00
77 #define S_DATA_PIX 0x40
78 #define S_DATA_PLN 0xC0
79
80
81
82 # define RESET_CREG 0x80
83
84
85
86 #define ROP(r2,r3,r0,r1) ( (U_SHORT)((r0)|((r1)<<4)|((r2)<<8)|((r3)<<12)) )
87 #define DEST_ZERO 0x0
88 #define SRC_AND_DEST 0x1
89 #define SRC_AND_nDEST 0x2
90 #define SRC 0x3
91 #define nSRC_AND_DEST 0x4
92 #define DEST 0x5
93 #define SRC_XOR_DEST 0x6
94 #define SRC_OR_DEST 0x7
95 #define SRC_NOR_DEST 0x8
96 #define SRC_XNOR_DEST 0x9
97 #define nDEST 0xA
98 #define SRC_OR_nDEST 0xB
99 #define nSRC 0xC
100 #define nSRC_OR_DEST 0xD
101 #define SRC_NAND_DEST 0xE
102 #define DEST_ONE 0xF
103
104 #define SWAP(A) ((A>>8) | ((A&0xff) <<8))
105
106
107
108 static int dnfb_blank(int blank, struct fb_info *info);
109 static void dnfb_copyarea(struct fb_info *info, const struct fb_copyarea *area);
110
111 static struct fb_ops dn_fb_ops = {
112 .owner = THIS_MODULE,
113 .fb_blank = dnfb_blank,
114 .fb_fillrect = cfb_fillrect,
115 .fb_copyarea = dnfb_copyarea,
116 .fb_imageblit = cfb_imageblit,
117 };
118
119 static const struct fb_var_screeninfo dnfb_var = {
120 .xres = 1280,
121 .yres = 1024,
122 .xres_virtual = 2048,
123 .yres_virtual = 1024,
124 .bits_per_pixel = 1,
125 .height = -1,
126 .width = -1,
127 .vmode = FB_VMODE_NONINTERLACED,
128 };
129
130 static const struct fb_fix_screeninfo dnfb_fix = {
131 .id = "Apollo Mono",
132 .smem_start = (FRAME_BUFFER_START + IO_BASE),
133 .smem_len = FRAME_BUFFER_LEN,
134 .type = FB_TYPE_PACKED_PIXELS,
135 .visual = FB_VISUAL_MONO10,
136 .line_length = 256,
137 };
138
139 static int dnfb_blank(int blank, struct fb_info *info)
140 {
141 if (blank)
142 out_8(AP_CONTROL_3A, 0x0);
143 else
144 out_8(AP_CONTROL_3A, 0x1);
145 return 0;
146 }
147
148 static
149 void dnfb_copyarea(struct fb_info *info, const struct fb_copyarea *area)
150 {
151
152 int incr, y_delta, pre_read = 0, x_end, x_word_count;
153 uint start_mask, end_mask, dest;
154 ushort *src, dummy;
155 short i, j;
156
157 incr = (area->dy <= area->sy) ? 1 : -1;
158
159 src = (ushort *)(info->screen_base + area->sy * info->fix.line_length +
160 (area->sx >> 4));
161 dest = area->dy * (info->fix.line_length >> 1) + (area->dx >> 4);
162
163 if (incr > 0) {
164 y_delta = (info->fix.line_length * 8) - area->sx - area->width;
165 x_end = area->dx + area->width - 1;
166 x_word_count = (x_end >> 4) - (area->dx >> 4) + 1;
167 start_mask = 0xffff0000 >> (area->dx & 0xf);
168 end_mask = 0x7ffff >> (x_end & 0xf);
169 out_8(AP_CONTROL_0,
170 (((area->dx & 0xf) - (area->sx & 0xf)) % 16) | (0x4 << 5));
171 if ((area->dx & 0xf) < (area->sx & 0xf))
172 pre_read = 1;
173 } else {
174 y_delta = -((info->fix.line_length * 8) - area->sx - area->width);
175 x_end = area->dx - area->width + 1;
176 x_word_count = (area->dx >> 4) - (x_end >> 4) + 1;
177 start_mask = 0x7ffff >> (area->dx & 0xf);
178 end_mask = 0xffff0000 >> (x_end & 0xf);
179 out_8(AP_CONTROL_0,
180 ((-((area->sx & 0xf) - (area->dx & 0xf))) % 16) |
181 (0x4 << 5));
182 if ((area->dx & 0xf) > (area->sx & 0xf))
183 pre_read = 1;
184 }
185
186 for (i = 0; i < area->height; i++) {
187
188 out_8(AP_CONTROL_3A, 0xc | (dest >> 16));
189
190 if (pre_read) {
191 dummy = *src;
192 src += incr;
193 }
194
195 if (x_word_count) {
196 out_8(AP_WRITE_ENABLE, start_mask);
197 *src = dest;
198 src += incr;
199 dest += incr;
200 out_8(AP_WRITE_ENABLE, 0);
201
202 for (j = 1; j < (x_word_count - 1); j++) {
203 *src = dest;
204 src += incr;
205 dest += incr;
206 }
207
208 out_8(AP_WRITE_ENABLE, start_mask);
209 *src = dest;
210 dest += incr;
211 src += incr;
212 } else {
213 out_8(AP_WRITE_ENABLE, start_mask | end_mask);
214 *src = dest;
215 dest += incr;
216 src += incr;
217 }
218 src += (y_delta / 16);
219 dest += (y_delta / 16);
220 }
221 out_8(AP_CONTROL_0, NORMAL_MODE);
222 }
223
224
225
226
227
228 static int dnfb_probe(struct platform_device *dev)
229 {
230 struct fb_info *info;
231 int err = 0;
232
233 info = framebuffer_alloc(0, &dev->dev);
234 if (!info)
235 return -ENOMEM;
236
237 info->fbops = &dn_fb_ops;
238 info->fix = dnfb_fix;
239 info->var = dnfb_var;
240 info->var.red.length = 1;
241 info->var.red.offset = 0;
242 info->var.green = info->var.blue = info->var.red;
243 info->screen_base = (u_char *) info->fix.smem_start;
244
245 err = fb_alloc_cmap(&info->cmap, 2, 0);
246 if (err < 0)
247 goto release_framebuffer;
248
249 err = register_framebuffer(info);
250 if (err < 0) {
251 fb_dealloc_cmap(&info->cmap);
252 goto release_framebuffer;
253 }
254 platform_set_drvdata(dev, info);
255
256
257 out_8(AP_CONTROL_3A, RESET_CREG);
258 out_be16(AP_WRITE_ENABLE, 0x0);
259 out_8(AP_CONTROL_0, NORMAL_MODE);
260 out_8(AP_CONTROL_1, (AD_BLT | DST_EQ_SRC | NORM_CREG1));
261 out_8(AP_CONTROL_2, S_DATA_PLN);
262 out_be16(AP_ROP_1, SWAP(0x3));
263
264 printk("apollo frame buffer alive and kicking !\n");
265 return err;
266
267 release_framebuffer:
268 framebuffer_release(info);
269 return err;
270 }
271
272 static struct platform_driver dnfb_driver = {
273 .probe = dnfb_probe,
274 .driver = {
275 .name = "dnfb",
276 },
277 };
278
279 static struct platform_device dnfb_device = {
280 .name = "dnfb",
281 };
282
283 int __init dnfb_init(void)
284 {
285 int ret;
286
287 if (!MACH_IS_APOLLO)
288 return -ENODEV;
289
290 if (fb_get_options("dnfb", NULL))
291 return -ENODEV;
292
293 ret = platform_driver_register(&dnfb_driver);
294
295 if (!ret) {
296 ret = platform_device_register(&dnfb_device);
297 if (ret)
298 platform_driver_unregister(&dnfb_driver);
299 }
300 return ret;
301 }
302
303 module_init(dnfb_init);
304
305 MODULE_LICENSE("GPL");