1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * newport_con.c: Abscon for newport hardware
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * (C) 1998 Thomas Bogendoerfer (tsbogend@alpha.franken.de)
6*4882a593Smuzhiyun * (C) 1999 Ulf Carlsson (ulfc@thepuffingruop.com)
7*4882a593Smuzhiyun *
8*4882a593Smuzhiyun * This driver is based on sgicons.c and cons_newport.
9*4882a593Smuzhiyun *
10*4882a593Smuzhiyun * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
11*4882a593Smuzhiyun * Copyright (C) 1997 Miguel de Icaza (miguel@nuclecu.unam.mx)
12*4882a593Smuzhiyun */
13*4882a593Smuzhiyun #include <linux/init.h>
14*4882a593Smuzhiyun #include <linux/kernel.h>
15*4882a593Smuzhiyun #include <linux/errno.h>
16*4882a593Smuzhiyun #include <linux/kd.h>
17*4882a593Smuzhiyun #include <linux/selection.h>
18*4882a593Smuzhiyun #include <linux/console.h>
19*4882a593Smuzhiyun #include <linux/vt_kern.h>
20*4882a593Smuzhiyun #include <linux/mm.h>
21*4882a593Smuzhiyun #include <linux/module.h>
22*4882a593Smuzhiyun #include <linux/slab.h>
23*4882a593Smuzhiyun
24*4882a593Smuzhiyun #include <asm/io.h>
25*4882a593Smuzhiyun #include <linux/uaccess.h>
26*4882a593Smuzhiyun #include <asm/page.h>
27*4882a593Smuzhiyun #include <asm/gio_device.h>
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun #include <video/newport.h>
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun #include <linux/linux_logo.h>
32*4882a593Smuzhiyun #include <linux/font.h>
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun #define NEWPORT_LEN 0x10000
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun #define FONT_DATA ((unsigned char *)font_vga_8x16.data)
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun static unsigned char *font_data[MAX_NR_CONSOLES];
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun static struct newport_regs *npregs;
41*4882a593Smuzhiyun static unsigned long newport_addr;
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun static int logo_active;
44*4882a593Smuzhiyun static int topscan;
45*4882a593Smuzhiyun static int xcurs_correction = 29;
46*4882a593Smuzhiyun static int newport_xsize;
47*4882a593Smuzhiyun static int newport_ysize;
48*4882a593Smuzhiyun static int newport_has_init;
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun static int newport_set_def_font(int unit, struct console_font *op);
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun #define BMASK(c) (c << 24)
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun #define RENDER(regs, cp) do { \
55*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0x0]); (regs)->go.zpattern = BMASK((cp)[0x1]); \
56*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0x2]); (regs)->go.zpattern = BMASK((cp)[0x3]); \
57*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0x4]); (regs)->go.zpattern = BMASK((cp)[0x5]); \
58*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0x6]); (regs)->go.zpattern = BMASK((cp)[0x7]); \
59*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0x8]); (regs)->go.zpattern = BMASK((cp)[0x9]); \
60*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0xa]); (regs)->go.zpattern = BMASK((cp)[0xb]); \
61*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0xc]); (regs)->go.zpattern = BMASK((cp)[0xd]); \
62*4882a593Smuzhiyun (regs)->go.zpattern = BMASK((cp)[0xe]); (regs)->go.zpattern = BMASK((cp)[0xf]); \
63*4882a593Smuzhiyun } while(0)
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun #define TESTVAL 0xdeadbeef
66*4882a593Smuzhiyun #define XSTI_TO_FXSTART(val) (((val) & 0xffff) << 11)
67*4882a593Smuzhiyun
newport_render_background(int xstart,int ystart,int xend,int yend,int ci)68*4882a593Smuzhiyun static inline void newport_render_background(int xstart, int ystart,
69*4882a593Smuzhiyun int xend, int yend, int ci)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun newport_wait(npregs);
72*4882a593Smuzhiyun npregs->set.wrmask = 0xffffffff;
73*4882a593Smuzhiyun npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
74*4882a593Smuzhiyun NPORT_DMODE0_DOSETUP | NPORT_DMODE0_STOPX
75*4882a593Smuzhiyun | NPORT_DMODE0_STOPY);
76*4882a593Smuzhiyun npregs->set.colori = ci;
77*4882a593Smuzhiyun npregs->set.xystarti =
78*4882a593Smuzhiyun (xstart << 16) | ((ystart + topscan) & 0x3ff);
79*4882a593Smuzhiyun npregs->go.xyendi =
80*4882a593Smuzhiyun ((xend + 7) << 16) | ((yend + topscan + 15) & 0x3ff);
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun
newport_init_cmap(void)83*4882a593Smuzhiyun static inline void newport_init_cmap(void)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun unsigned short i;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun for (i = 0; i < 16; i++) {
88*4882a593Smuzhiyun newport_bfwait(npregs);
89*4882a593Smuzhiyun newport_cmap_setaddr(npregs, color_table[i]);
90*4882a593Smuzhiyun newport_cmap_setrgb(npregs,
91*4882a593Smuzhiyun default_red[i],
92*4882a593Smuzhiyun default_grn[i], default_blu[i]);
93*4882a593Smuzhiyun }
94*4882a593Smuzhiyun }
95*4882a593Smuzhiyun
newport_show_logo(void)96*4882a593Smuzhiyun static const struct linux_logo *newport_show_logo(void)
97*4882a593Smuzhiyun {
98*4882a593Smuzhiyun #ifdef CONFIG_LOGO_SGI_CLUT224
99*4882a593Smuzhiyun const struct linux_logo *logo = fb_find_logo(8);
100*4882a593Smuzhiyun const unsigned char *clut;
101*4882a593Smuzhiyun const unsigned char *data;
102*4882a593Smuzhiyun unsigned long i;
103*4882a593Smuzhiyun
104*4882a593Smuzhiyun if (!logo)
105*4882a593Smuzhiyun return NULL;
106*4882a593Smuzhiyun clut = logo->clut;
107*4882a593Smuzhiyun data = logo->data;
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun for (i = 0; i < logo->clutsize; i++) {
110*4882a593Smuzhiyun newport_bfwait(npregs);
111*4882a593Smuzhiyun newport_cmap_setaddr(npregs, i + 0x20);
112*4882a593Smuzhiyun newport_cmap_setrgb(npregs, clut[0], clut[1], clut[2]);
113*4882a593Smuzhiyun clut += 3;
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun newport_wait(npregs);
117*4882a593Smuzhiyun npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
118*4882a593Smuzhiyun NPORT_DMODE0_CHOST);
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun npregs->set.xystarti = ((newport_xsize - logo->width) << 16) | (0);
121*4882a593Smuzhiyun npregs->set.xyendi = ((newport_xsize - 1) << 16);
122*4882a593Smuzhiyun newport_wait(npregs);
123*4882a593Smuzhiyun
124*4882a593Smuzhiyun for (i = 0; i < logo->width*logo->height; i++)
125*4882a593Smuzhiyun npregs->go.hostrw0 = *data++ << 24;
126*4882a593Smuzhiyun
127*4882a593Smuzhiyun return logo;
128*4882a593Smuzhiyun #else
129*4882a593Smuzhiyun return NULL;
130*4882a593Smuzhiyun #endif /* CONFIG_LOGO_SGI_CLUT224 */
131*4882a593Smuzhiyun }
132*4882a593Smuzhiyun
newport_clear_screen(int xstart,int ystart,int xend,int yend,int ci)133*4882a593Smuzhiyun static inline void newport_clear_screen(int xstart, int ystart, int xend,
134*4882a593Smuzhiyun int yend, int ci)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun if (logo_active)
137*4882a593Smuzhiyun return;
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun newport_wait(npregs);
140*4882a593Smuzhiyun npregs->set.wrmask = 0xffffffff;
141*4882a593Smuzhiyun npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
142*4882a593Smuzhiyun NPORT_DMODE0_DOSETUP | NPORT_DMODE0_STOPX
143*4882a593Smuzhiyun | NPORT_DMODE0_STOPY);
144*4882a593Smuzhiyun npregs->set.colori = ci;
145*4882a593Smuzhiyun npregs->set.xystarti = (xstart << 16) | ystart;
146*4882a593Smuzhiyun npregs->go.xyendi = (xend << 16) | yend;
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun
newport_clear_lines(int ystart,int yend,int ci)149*4882a593Smuzhiyun static inline void newport_clear_lines(int ystart, int yend, int ci)
150*4882a593Smuzhiyun {
151*4882a593Smuzhiyun ystart = ((ystart << 4) + topscan) & 0x3ff;
152*4882a593Smuzhiyun yend = ((yend << 4) + topscan + 15) & 0x3ff;
153*4882a593Smuzhiyun newport_clear_screen(0, ystart, 1280 + 63, yend, ci);
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun
newport_reset(void)156*4882a593Smuzhiyun static void newport_reset(void)
157*4882a593Smuzhiyun {
158*4882a593Smuzhiyun unsigned short treg;
159*4882a593Smuzhiyun int i;
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun newport_wait(npregs);
162*4882a593Smuzhiyun treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
163*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CONTROL,
164*4882a593Smuzhiyun (treg | VC2_CTRL_EVIDEO));
165*4882a593Smuzhiyun
166*4882a593Smuzhiyun treg = newport_vc2_get(npregs, VC2_IREG_CENTRY);
167*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_RADDR, treg);
168*4882a593Smuzhiyun npregs->set.dcbmode = (NPORT_DMODE_AVC2 | VC2_REGADDR_RAM |
169*4882a593Smuzhiyun NPORT_DMODE_W2 | VC2_PROTOCOL);
170*4882a593Smuzhiyun for (i = 0; i < 128; i++) {
171*4882a593Smuzhiyun newport_bfwait(npregs);
172*4882a593Smuzhiyun if (i == 92 || i == 94)
173*4882a593Smuzhiyun npregs->set.dcbdata0.byshort.s1 = 0xff00;
174*4882a593Smuzhiyun else
175*4882a593Smuzhiyun npregs->set.dcbdata0.byshort.s1 = 0x0000;
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun newport_init_cmap();
179*4882a593Smuzhiyun
180*4882a593Smuzhiyun /* turn off popup plane */
181*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_XMAP0 | R_DCB_XMAP9_PROTOCOL |
182*4882a593Smuzhiyun XM9_CRS_CONFIG | NPORT_DMODE_W1);
183*4882a593Smuzhiyun npregs->set.dcbdata0.bybytes.b3 &= ~XM9_PUPMODE;
184*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_XMAP1 | R_DCB_XMAP9_PROTOCOL |
185*4882a593Smuzhiyun XM9_CRS_CONFIG | NPORT_DMODE_W1);
186*4882a593Smuzhiyun npregs->set.dcbdata0.bybytes.b3 &= ~XM9_PUPMODE;
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun topscan = 0;
189*4882a593Smuzhiyun npregs->cset.topscan = 0x3ff;
190*4882a593Smuzhiyun npregs->cset.xywin = (4096 << 16) | 4096;
191*4882a593Smuzhiyun
192*4882a593Smuzhiyun /* Clear the screen. */
193*4882a593Smuzhiyun newport_clear_screen(0, 0, 1280 + 63, 1024, 0);
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun
196*4882a593Smuzhiyun /*
197*4882a593Smuzhiyun * calculate the actual screen size by reading
198*4882a593Smuzhiyun * the video timing out of the VC2
199*4882a593Smuzhiyun */
newport_get_screensize(void)200*4882a593Smuzhiyun static void newport_get_screensize(void)
201*4882a593Smuzhiyun {
202*4882a593Smuzhiyun int i, cols;
203*4882a593Smuzhiyun unsigned short ventry, treg;
204*4882a593Smuzhiyun unsigned short linetable[128]; /* should be enough */
205*4882a593Smuzhiyun
206*4882a593Smuzhiyun ventry = newport_vc2_get(npregs, VC2_IREG_VENTRY);
207*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_RADDR, ventry);
208*4882a593Smuzhiyun npregs->set.dcbmode = (NPORT_DMODE_AVC2 | VC2_REGADDR_RAM |
209*4882a593Smuzhiyun NPORT_DMODE_W2 | VC2_PROTOCOL);
210*4882a593Smuzhiyun for (i = 0; i < 128; i++) {
211*4882a593Smuzhiyun newport_bfwait(npregs);
212*4882a593Smuzhiyun linetable[i] = npregs->set.dcbdata0.byshort.s1;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun
215*4882a593Smuzhiyun newport_xsize = newport_ysize = 0;
216*4882a593Smuzhiyun for (i = 0; i < ARRAY_SIZE(linetable) - 1 && linetable[i + 1]; i += 2) {
217*4882a593Smuzhiyun cols = 0;
218*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_RADDR, linetable[i]);
219*4882a593Smuzhiyun npregs->set.dcbmode = (NPORT_DMODE_AVC2 | VC2_REGADDR_RAM |
220*4882a593Smuzhiyun NPORT_DMODE_W2 | VC2_PROTOCOL);
221*4882a593Smuzhiyun do {
222*4882a593Smuzhiyun newport_bfwait(npregs);
223*4882a593Smuzhiyun treg = npregs->set.dcbdata0.byshort.s1;
224*4882a593Smuzhiyun if ((treg & 1) == 0)
225*4882a593Smuzhiyun cols += (treg >> 7) & 0xfe;
226*4882a593Smuzhiyun if ((treg & 0x80) == 0) {
227*4882a593Smuzhiyun newport_bfwait(npregs);
228*4882a593Smuzhiyun treg = npregs->set.dcbdata0.byshort.s1;
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun } while ((treg & 0x8000) == 0);
231*4882a593Smuzhiyun if (cols) {
232*4882a593Smuzhiyun if (cols > newport_xsize)
233*4882a593Smuzhiyun newport_xsize = cols;
234*4882a593Smuzhiyun newport_ysize += linetable[i + 1];
235*4882a593Smuzhiyun }
236*4882a593Smuzhiyun }
237*4882a593Smuzhiyun printk("NG1: Screensize %dx%d\n", newport_xsize, newport_ysize);
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun
newport_get_revisions(void)240*4882a593Smuzhiyun static void newport_get_revisions(void)
241*4882a593Smuzhiyun {
242*4882a593Smuzhiyun unsigned int tmp;
243*4882a593Smuzhiyun unsigned int board_rev;
244*4882a593Smuzhiyun unsigned int rex3_rev;
245*4882a593Smuzhiyun unsigned int vc2_rev;
246*4882a593Smuzhiyun unsigned int cmap_rev;
247*4882a593Smuzhiyun unsigned int xmap9_rev;
248*4882a593Smuzhiyun unsigned int bt445_rev;
249*4882a593Smuzhiyun unsigned int bitplanes;
250*4882a593Smuzhiyun
251*4882a593Smuzhiyun rex3_rev = npregs->cset.status & NPORT_STAT_VERS;
252*4882a593Smuzhiyun
253*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_CMAP0 | NCMAP_PROTOCOL |
254*4882a593Smuzhiyun NCMAP_REGADDR_RREG | NPORT_DMODE_W1);
255*4882a593Smuzhiyun tmp = npregs->set.dcbdata0.bybytes.b3;
256*4882a593Smuzhiyun cmap_rev = tmp & 7;
257*4882a593Smuzhiyun board_rev = (tmp >> 4) & 7;
258*4882a593Smuzhiyun bitplanes = ((board_rev > 1) && (tmp & 0x80)) ? 8 : 24;
259*4882a593Smuzhiyun
260*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_CMAP1 | NCMAP_PROTOCOL |
261*4882a593Smuzhiyun NCMAP_REGADDR_RREG | NPORT_DMODE_W1);
262*4882a593Smuzhiyun tmp = npregs->set.dcbdata0.bybytes.b3;
263*4882a593Smuzhiyun if ((tmp & 7) < cmap_rev)
264*4882a593Smuzhiyun cmap_rev = (tmp & 7);
265*4882a593Smuzhiyun
266*4882a593Smuzhiyun vc2_rev = (newport_vc2_get(npregs, VC2_IREG_CONFIG) >> 5) & 7;
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_XMAP0 | R_DCB_XMAP9_PROTOCOL |
269*4882a593Smuzhiyun XM9_CRS_REVISION | NPORT_DMODE_W1);
270*4882a593Smuzhiyun xmap9_rev = npregs->set.dcbdata0.bybytes.b3 & 7;
271*4882a593Smuzhiyun
272*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_BT445 | BT445_PROTOCOL |
273*4882a593Smuzhiyun BT445_CSR_ADDR_REG | NPORT_DMODE_W1);
274*4882a593Smuzhiyun npregs->set.dcbdata0.bybytes.b3 = BT445_REVISION_REG;
275*4882a593Smuzhiyun npregs->set.dcbmode = (DCB_BT445 | BT445_PROTOCOL |
276*4882a593Smuzhiyun BT445_CSR_REVISION | NPORT_DMODE_W1);
277*4882a593Smuzhiyun bt445_rev = (npregs->set.dcbdata0.bybytes.b3 >> 4) - 0x0a;
278*4882a593Smuzhiyun
279*4882a593Smuzhiyun #define L(a) (char)('A'+(a))
280*4882a593Smuzhiyun printk
281*4882a593Smuzhiyun ("NG1: Revision %d, %d bitplanes, REX3 revision %c, VC2 revision %c, xmap9 revision %c, cmap revision %c, bt445 revision %c\n",
282*4882a593Smuzhiyun board_rev, bitplanes, L(rex3_rev), L(vc2_rev), L(xmap9_rev),
283*4882a593Smuzhiyun L(cmap_rev ? (cmap_rev + 1) : 0), L(bt445_rev));
284*4882a593Smuzhiyun #undef L
285*4882a593Smuzhiyun
286*4882a593Smuzhiyun if (board_rev == 3) /* I don't know all affected revisions */
287*4882a593Smuzhiyun xcurs_correction = 21;
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun
newport_exit(void)290*4882a593Smuzhiyun static void newport_exit(void)
291*4882a593Smuzhiyun {
292*4882a593Smuzhiyun int i;
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun /* free memory used by user font */
295*4882a593Smuzhiyun for (i = 0; i < MAX_NR_CONSOLES; i++)
296*4882a593Smuzhiyun newport_set_def_font(i, NULL);
297*4882a593Smuzhiyun }
298*4882a593Smuzhiyun
299*4882a593Smuzhiyun /* Can't be __init, do_take_over_console may call it later */
newport_startup(void)300*4882a593Smuzhiyun static const char *newport_startup(void)
301*4882a593Smuzhiyun {
302*4882a593Smuzhiyun int i;
303*4882a593Smuzhiyun
304*4882a593Smuzhiyun npregs->cset.config = NPORT_CFG_GD0;
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun if (newport_wait(npregs))
307*4882a593Smuzhiyun goto out_unmap;
308*4882a593Smuzhiyun
309*4882a593Smuzhiyun npregs->set.xstarti = TESTVAL;
310*4882a593Smuzhiyun if (npregs->set._xstart.word != XSTI_TO_FXSTART(TESTVAL))
311*4882a593Smuzhiyun goto out_unmap;
312*4882a593Smuzhiyun
313*4882a593Smuzhiyun for (i = 0; i < MAX_NR_CONSOLES; i++)
314*4882a593Smuzhiyun font_data[i] = FONT_DATA;
315*4882a593Smuzhiyun
316*4882a593Smuzhiyun newport_reset();
317*4882a593Smuzhiyun newport_get_revisions();
318*4882a593Smuzhiyun newport_get_screensize();
319*4882a593Smuzhiyun newport_has_init = 1;
320*4882a593Smuzhiyun
321*4882a593Smuzhiyun return "SGI Newport";
322*4882a593Smuzhiyun
323*4882a593Smuzhiyun out_unmap:
324*4882a593Smuzhiyun return NULL;
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun
newport_init(struct vc_data * vc,int init)327*4882a593Smuzhiyun static void newport_init(struct vc_data *vc, int init)
328*4882a593Smuzhiyun {
329*4882a593Smuzhiyun int cols, rows;
330*4882a593Smuzhiyun
331*4882a593Smuzhiyun cols = newport_xsize / 8;
332*4882a593Smuzhiyun rows = newport_ysize / 16;
333*4882a593Smuzhiyun vc->vc_can_do_color = 1;
334*4882a593Smuzhiyun if (init) {
335*4882a593Smuzhiyun vc->vc_cols = cols;
336*4882a593Smuzhiyun vc->vc_rows = rows;
337*4882a593Smuzhiyun } else
338*4882a593Smuzhiyun vc_resize(vc, cols, rows);
339*4882a593Smuzhiyun }
340*4882a593Smuzhiyun
newport_deinit(struct vc_data * c)341*4882a593Smuzhiyun static void newport_deinit(struct vc_data *c)
342*4882a593Smuzhiyun {
343*4882a593Smuzhiyun if (!con_is_bound(&newport_con) && newport_has_init) {
344*4882a593Smuzhiyun newport_exit();
345*4882a593Smuzhiyun newport_has_init = 0;
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun }
348*4882a593Smuzhiyun
newport_clear(struct vc_data * vc,int sy,int sx,int height,int width)349*4882a593Smuzhiyun static void newport_clear(struct vc_data *vc, int sy, int sx, int height,
350*4882a593Smuzhiyun int width)
351*4882a593Smuzhiyun {
352*4882a593Smuzhiyun int xend = ((sx + width) << 3) - 1;
353*4882a593Smuzhiyun int ystart = ((sy << 4) + topscan) & 0x3ff;
354*4882a593Smuzhiyun int yend = (((sy + height) << 4) + topscan - 1) & 0x3ff;
355*4882a593Smuzhiyun
356*4882a593Smuzhiyun if (logo_active)
357*4882a593Smuzhiyun return;
358*4882a593Smuzhiyun
359*4882a593Smuzhiyun if (ystart < yend) {
360*4882a593Smuzhiyun newport_clear_screen(sx << 3, ystart, xend, yend,
361*4882a593Smuzhiyun (vc->state.color & 0xf0) >> 4);
362*4882a593Smuzhiyun } else {
363*4882a593Smuzhiyun newport_clear_screen(sx << 3, ystart, xend, 1023,
364*4882a593Smuzhiyun (vc->state.color & 0xf0) >> 4);
365*4882a593Smuzhiyun newport_clear_screen(sx << 3, 0, xend, yend,
366*4882a593Smuzhiyun (vc->state.color & 0xf0) >> 4);
367*4882a593Smuzhiyun }
368*4882a593Smuzhiyun }
369*4882a593Smuzhiyun
newport_putc(struct vc_data * vc,int charattr,int ypos,int xpos)370*4882a593Smuzhiyun static void newport_putc(struct vc_data *vc, int charattr, int ypos,
371*4882a593Smuzhiyun int xpos)
372*4882a593Smuzhiyun {
373*4882a593Smuzhiyun unsigned char *p;
374*4882a593Smuzhiyun
375*4882a593Smuzhiyun p = &font_data[vc->vc_num][(charattr & 0xff) << 4];
376*4882a593Smuzhiyun charattr = (charattr >> 8) & 0xff;
377*4882a593Smuzhiyun xpos <<= 3;
378*4882a593Smuzhiyun ypos <<= 4;
379*4882a593Smuzhiyun
380*4882a593Smuzhiyun newport_render_background(xpos, ypos, xpos, ypos,
381*4882a593Smuzhiyun (charattr & 0xf0) >> 4);
382*4882a593Smuzhiyun
383*4882a593Smuzhiyun /* Set the color and drawing mode. */
384*4882a593Smuzhiyun newport_wait(npregs);
385*4882a593Smuzhiyun npregs->set.colori = charattr & 0xf;
386*4882a593Smuzhiyun npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
387*4882a593Smuzhiyun NPORT_DMODE0_STOPX | NPORT_DMODE0_ZPENAB |
388*4882a593Smuzhiyun NPORT_DMODE0_L32);
389*4882a593Smuzhiyun
390*4882a593Smuzhiyun /* Set coordinates for bitmap operation. */
391*4882a593Smuzhiyun npregs->set.xystarti = (xpos << 16) | ((ypos + topscan) & 0x3ff);
392*4882a593Smuzhiyun npregs->set.xyendi = ((xpos + 7) << 16);
393*4882a593Smuzhiyun newport_wait(npregs);
394*4882a593Smuzhiyun
395*4882a593Smuzhiyun /* Go, baby, go... */
396*4882a593Smuzhiyun RENDER(npregs, p);
397*4882a593Smuzhiyun }
398*4882a593Smuzhiyun
newport_putcs(struct vc_data * vc,const unsigned short * s,int count,int ypos,int xpos)399*4882a593Smuzhiyun static void newport_putcs(struct vc_data *vc, const unsigned short *s,
400*4882a593Smuzhiyun int count, int ypos, int xpos)
401*4882a593Smuzhiyun {
402*4882a593Smuzhiyun int i;
403*4882a593Smuzhiyun int charattr;
404*4882a593Smuzhiyun unsigned char *p;
405*4882a593Smuzhiyun
406*4882a593Smuzhiyun charattr = (scr_readw(s) >> 8) & 0xff;
407*4882a593Smuzhiyun
408*4882a593Smuzhiyun xpos <<= 3;
409*4882a593Smuzhiyun ypos <<= 4;
410*4882a593Smuzhiyun
411*4882a593Smuzhiyun if (!logo_active)
412*4882a593Smuzhiyun /* Clear the area behing the string */
413*4882a593Smuzhiyun newport_render_background(xpos, ypos,
414*4882a593Smuzhiyun xpos + ((count - 1) << 3), ypos,
415*4882a593Smuzhiyun (charattr & 0xf0) >> 4);
416*4882a593Smuzhiyun
417*4882a593Smuzhiyun newport_wait(npregs);
418*4882a593Smuzhiyun
419*4882a593Smuzhiyun /* Set the color and drawing mode. */
420*4882a593Smuzhiyun npregs->set.colori = charattr & 0xf;
421*4882a593Smuzhiyun npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
422*4882a593Smuzhiyun NPORT_DMODE0_STOPX | NPORT_DMODE0_ZPENAB |
423*4882a593Smuzhiyun NPORT_DMODE0_L32);
424*4882a593Smuzhiyun
425*4882a593Smuzhiyun for (i = 0; i < count; i++, xpos += 8) {
426*4882a593Smuzhiyun p = &font_data[vc->vc_num][(scr_readw(s++) & 0xff) << 4];
427*4882a593Smuzhiyun
428*4882a593Smuzhiyun newport_wait(npregs);
429*4882a593Smuzhiyun
430*4882a593Smuzhiyun /* Set coordinates for bitmap operation. */
431*4882a593Smuzhiyun npregs->set.xystarti =
432*4882a593Smuzhiyun (xpos << 16) | ((ypos + topscan) & 0x3ff);
433*4882a593Smuzhiyun npregs->set.xyendi = ((xpos + 7) << 16);
434*4882a593Smuzhiyun
435*4882a593Smuzhiyun /* Go, baby, go... */
436*4882a593Smuzhiyun RENDER(npregs, p);
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun }
439*4882a593Smuzhiyun
newport_cursor(struct vc_data * vc,int mode)440*4882a593Smuzhiyun static void newport_cursor(struct vc_data *vc, int mode)
441*4882a593Smuzhiyun {
442*4882a593Smuzhiyun unsigned short treg;
443*4882a593Smuzhiyun int xcurs, ycurs;
444*4882a593Smuzhiyun
445*4882a593Smuzhiyun switch (mode) {
446*4882a593Smuzhiyun case CM_ERASE:
447*4882a593Smuzhiyun treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
448*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CONTROL,
449*4882a593Smuzhiyun (treg & ~(VC2_CTRL_ECDISP)));
450*4882a593Smuzhiyun break;
451*4882a593Smuzhiyun
452*4882a593Smuzhiyun case CM_MOVE:
453*4882a593Smuzhiyun case CM_DRAW:
454*4882a593Smuzhiyun treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
455*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CONTROL,
456*4882a593Smuzhiyun (treg | VC2_CTRL_ECDISP));
457*4882a593Smuzhiyun xcurs = (vc->vc_pos - vc->vc_visible_origin) / 2;
458*4882a593Smuzhiyun ycurs = ((xcurs / vc->vc_cols) << 4) + 31;
459*4882a593Smuzhiyun xcurs = ((xcurs % vc->vc_cols) << 3) + xcurs_correction;
460*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CURSX, xcurs);
461*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CURSY, ycurs);
462*4882a593Smuzhiyun }
463*4882a593Smuzhiyun }
464*4882a593Smuzhiyun
newport_switch(struct vc_data * vc)465*4882a593Smuzhiyun static int newport_switch(struct vc_data *vc)
466*4882a593Smuzhiyun {
467*4882a593Smuzhiyun static int logo_drawn = 0;
468*4882a593Smuzhiyun
469*4882a593Smuzhiyun topscan = 0;
470*4882a593Smuzhiyun npregs->cset.topscan = 0x3ff;
471*4882a593Smuzhiyun
472*4882a593Smuzhiyun if (!logo_drawn) {
473*4882a593Smuzhiyun if (newport_show_logo()) {
474*4882a593Smuzhiyun logo_drawn = 1;
475*4882a593Smuzhiyun logo_active = 1;
476*4882a593Smuzhiyun }
477*4882a593Smuzhiyun }
478*4882a593Smuzhiyun
479*4882a593Smuzhiyun return 1;
480*4882a593Smuzhiyun }
481*4882a593Smuzhiyun
newport_blank(struct vc_data * c,int blank,int mode_switch)482*4882a593Smuzhiyun static int newport_blank(struct vc_data *c, int blank, int mode_switch)
483*4882a593Smuzhiyun {
484*4882a593Smuzhiyun unsigned short treg;
485*4882a593Smuzhiyun
486*4882a593Smuzhiyun if (blank == 0) {
487*4882a593Smuzhiyun /* unblank console */
488*4882a593Smuzhiyun treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
489*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CONTROL,
490*4882a593Smuzhiyun (treg | VC2_CTRL_EDISP));
491*4882a593Smuzhiyun } else {
492*4882a593Smuzhiyun /* blank console */
493*4882a593Smuzhiyun treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
494*4882a593Smuzhiyun newport_vc2_set(npregs, VC2_IREG_CONTROL,
495*4882a593Smuzhiyun (treg & ~(VC2_CTRL_EDISP)));
496*4882a593Smuzhiyun }
497*4882a593Smuzhiyun return 1;
498*4882a593Smuzhiyun }
499*4882a593Smuzhiyun
newport_set_font(int unit,struct console_font * op)500*4882a593Smuzhiyun static int newport_set_font(int unit, struct console_font *op)
501*4882a593Smuzhiyun {
502*4882a593Smuzhiyun int w = op->width;
503*4882a593Smuzhiyun int h = op->height;
504*4882a593Smuzhiyun int size = h * op->charcount;
505*4882a593Smuzhiyun int i;
506*4882a593Smuzhiyun unsigned char *new_data, *data = op->data, *p;
507*4882a593Smuzhiyun
508*4882a593Smuzhiyun /* ladis: when I grow up, there will be a day... and more sizes will
509*4882a593Smuzhiyun * be supported ;-) */
510*4882a593Smuzhiyun if ((w != 8) || (h != 16)
511*4882a593Smuzhiyun || (op->charcount != 256 && op->charcount != 512))
512*4882a593Smuzhiyun return -EINVAL;
513*4882a593Smuzhiyun
514*4882a593Smuzhiyun if (!(new_data = kmalloc(FONT_EXTRA_WORDS * sizeof(int) + size,
515*4882a593Smuzhiyun GFP_USER))) return -ENOMEM;
516*4882a593Smuzhiyun
517*4882a593Smuzhiyun new_data += FONT_EXTRA_WORDS * sizeof(int);
518*4882a593Smuzhiyun FNTSIZE(new_data) = size;
519*4882a593Smuzhiyun FNTCHARCNT(new_data) = op->charcount;
520*4882a593Smuzhiyun REFCOUNT(new_data) = 0; /* usage counter */
521*4882a593Smuzhiyun FNTSUM(new_data) = 0;
522*4882a593Smuzhiyun
523*4882a593Smuzhiyun p = new_data;
524*4882a593Smuzhiyun for (i = 0; i < op->charcount; i++) {
525*4882a593Smuzhiyun memcpy(p, data, h);
526*4882a593Smuzhiyun data += 32;
527*4882a593Smuzhiyun p += h;
528*4882a593Smuzhiyun }
529*4882a593Smuzhiyun
530*4882a593Smuzhiyun /* check if font is already used by other console */
531*4882a593Smuzhiyun for (i = 0; i < MAX_NR_CONSOLES; i++) {
532*4882a593Smuzhiyun if (font_data[i] != FONT_DATA
533*4882a593Smuzhiyun && FNTSIZE(font_data[i]) == size
534*4882a593Smuzhiyun && !memcmp(font_data[i], new_data, size)) {
535*4882a593Smuzhiyun kfree(new_data - FONT_EXTRA_WORDS * sizeof(int));
536*4882a593Smuzhiyun /* current font is the same as the new one */
537*4882a593Smuzhiyun if (i == unit)
538*4882a593Smuzhiyun return 0;
539*4882a593Smuzhiyun new_data = font_data[i];
540*4882a593Smuzhiyun break;
541*4882a593Smuzhiyun }
542*4882a593Smuzhiyun }
543*4882a593Smuzhiyun /* old font is user font */
544*4882a593Smuzhiyun if (font_data[unit] != FONT_DATA) {
545*4882a593Smuzhiyun if (--REFCOUNT(font_data[unit]) == 0)
546*4882a593Smuzhiyun kfree(font_data[unit] -
547*4882a593Smuzhiyun FONT_EXTRA_WORDS * sizeof(int));
548*4882a593Smuzhiyun }
549*4882a593Smuzhiyun REFCOUNT(new_data)++;
550*4882a593Smuzhiyun font_data[unit] = new_data;
551*4882a593Smuzhiyun
552*4882a593Smuzhiyun return 0;
553*4882a593Smuzhiyun }
554*4882a593Smuzhiyun
newport_set_def_font(int unit,struct console_font * op)555*4882a593Smuzhiyun static int newport_set_def_font(int unit, struct console_font *op)
556*4882a593Smuzhiyun {
557*4882a593Smuzhiyun if (font_data[unit] != FONT_DATA) {
558*4882a593Smuzhiyun if (--REFCOUNT(font_data[unit]) == 0)
559*4882a593Smuzhiyun kfree(font_data[unit] -
560*4882a593Smuzhiyun FONT_EXTRA_WORDS * sizeof(int));
561*4882a593Smuzhiyun font_data[unit] = FONT_DATA;
562*4882a593Smuzhiyun }
563*4882a593Smuzhiyun
564*4882a593Smuzhiyun return 0;
565*4882a593Smuzhiyun }
566*4882a593Smuzhiyun
newport_font_default(struct vc_data * vc,struct console_font * op,char * name)567*4882a593Smuzhiyun static int newport_font_default(struct vc_data *vc, struct console_font *op, char *name)
568*4882a593Smuzhiyun {
569*4882a593Smuzhiyun return newport_set_def_font(vc->vc_num, op);
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun
newport_font_set(struct vc_data * vc,struct console_font * font,unsigned flags)572*4882a593Smuzhiyun static int newport_font_set(struct vc_data *vc, struct console_font *font, unsigned flags)
573*4882a593Smuzhiyun {
574*4882a593Smuzhiyun return newport_set_font(vc->vc_num, font);
575*4882a593Smuzhiyun }
576*4882a593Smuzhiyun
newport_scroll(struct vc_data * vc,unsigned int t,unsigned int b,enum con_scroll dir,unsigned int lines)577*4882a593Smuzhiyun static bool newport_scroll(struct vc_data *vc, unsigned int t, unsigned int b,
578*4882a593Smuzhiyun enum con_scroll dir, unsigned int lines)
579*4882a593Smuzhiyun {
580*4882a593Smuzhiyun int count, x, y;
581*4882a593Smuzhiyun unsigned short *s, *d;
582*4882a593Smuzhiyun unsigned short chattr;
583*4882a593Smuzhiyun
584*4882a593Smuzhiyun logo_active = 0; /* it's time to disable the logo now.. */
585*4882a593Smuzhiyun
586*4882a593Smuzhiyun if (t == 0 && b == vc->vc_rows) {
587*4882a593Smuzhiyun if (dir == SM_UP) {
588*4882a593Smuzhiyun topscan = (topscan + (lines << 4)) & 0x3ff;
589*4882a593Smuzhiyun newport_clear_lines(vc->vc_rows - lines,
590*4882a593Smuzhiyun vc->vc_rows - 1,
591*4882a593Smuzhiyun (vc->state.color & 0xf0) >> 4);
592*4882a593Smuzhiyun } else {
593*4882a593Smuzhiyun topscan = (topscan + (-lines << 4)) & 0x3ff;
594*4882a593Smuzhiyun newport_clear_lines(0, lines - 1,
595*4882a593Smuzhiyun (vc->state.color & 0xf0) >> 4);
596*4882a593Smuzhiyun }
597*4882a593Smuzhiyun npregs->cset.topscan = (topscan - 1) & 0x3ff;
598*4882a593Smuzhiyun return false;
599*4882a593Smuzhiyun }
600*4882a593Smuzhiyun
601*4882a593Smuzhiyun count = (b - t - lines) * vc->vc_cols;
602*4882a593Smuzhiyun if (dir == SM_UP) {
603*4882a593Smuzhiyun x = 0;
604*4882a593Smuzhiyun y = t;
605*4882a593Smuzhiyun s = (unsigned short *) (vc->vc_origin +
606*4882a593Smuzhiyun vc->vc_size_row * (t + lines));
607*4882a593Smuzhiyun d = (unsigned short *) (vc->vc_origin +
608*4882a593Smuzhiyun vc->vc_size_row * t);
609*4882a593Smuzhiyun while (count--) {
610*4882a593Smuzhiyun chattr = scr_readw(s++);
611*4882a593Smuzhiyun if (chattr != scr_readw(d)) {
612*4882a593Smuzhiyun newport_putc(vc, chattr, y, x);
613*4882a593Smuzhiyun scr_writew(chattr, d);
614*4882a593Smuzhiyun }
615*4882a593Smuzhiyun d++;
616*4882a593Smuzhiyun if (++x == vc->vc_cols) {
617*4882a593Smuzhiyun x = 0;
618*4882a593Smuzhiyun y++;
619*4882a593Smuzhiyun }
620*4882a593Smuzhiyun }
621*4882a593Smuzhiyun d = (unsigned short *) (vc->vc_origin +
622*4882a593Smuzhiyun vc->vc_size_row * (b - lines));
623*4882a593Smuzhiyun x = 0;
624*4882a593Smuzhiyun y = b - lines;
625*4882a593Smuzhiyun for (count = 0; count < (lines * vc->vc_cols); count++) {
626*4882a593Smuzhiyun if (scr_readw(d) != vc->vc_video_erase_char) {
627*4882a593Smuzhiyun newport_putc(vc, vc->vc_video_erase_char,
628*4882a593Smuzhiyun y, x);
629*4882a593Smuzhiyun scr_writew(vc->vc_video_erase_char, d);
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun d++;
632*4882a593Smuzhiyun if (++x == vc->vc_cols) {
633*4882a593Smuzhiyun x = 0;
634*4882a593Smuzhiyun y++;
635*4882a593Smuzhiyun }
636*4882a593Smuzhiyun }
637*4882a593Smuzhiyun } else {
638*4882a593Smuzhiyun x = vc->vc_cols - 1;
639*4882a593Smuzhiyun y = b - 1;
640*4882a593Smuzhiyun s = (unsigned short *) (vc->vc_origin +
641*4882a593Smuzhiyun vc->vc_size_row * (b - lines) - 2);
642*4882a593Smuzhiyun d = (unsigned short *) (vc->vc_origin +
643*4882a593Smuzhiyun vc->vc_size_row * b - 2);
644*4882a593Smuzhiyun while (count--) {
645*4882a593Smuzhiyun chattr = scr_readw(s--);
646*4882a593Smuzhiyun if (chattr != scr_readw(d)) {
647*4882a593Smuzhiyun newport_putc(vc, chattr, y, x);
648*4882a593Smuzhiyun scr_writew(chattr, d);
649*4882a593Smuzhiyun }
650*4882a593Smuzhiyun d--;
651*4882a593Smuzhiyun if (x-- == 0) {
652*4882a593Smuzhiyun x = vc->vc_cols - 1;
653*4882a593Smuzhiyun y--;
654*4882a593Smuzhiyun }
655*4882a593Smuzhiyun }
656*4882a593Smuzhiyun d = (unsigned short *) (vc->vc_origin +
657*4882a593Smuzhiyun vc->vc_size_row * t);
658*4882a593Smuzhiyun x = 0;
659*4882a593Smuzhiyun y = t;
660*4882a593Smuzhiyun for (count = 0; count < (lines * vc->vc_cols); count++) {
661*4882a593Smuzhiyun if (scr_readw(d) != vc->vc_video_erase_char) {
662*4882a593Smuzhiyun newport_putc(vc, vc->vc_video_erase_char,
663*4882a593Smuzhiyun y, x);
664*4882a593Smuzhiyun scr_writew(vc->vc_video_erase_char, d);
665*4882a593Smuzhiyun }
666*4882a593Smuzhiyun d++;
667*4882a593Smuzhiyun if (++x == vc->vc_cols) {
668*4882a593Smuzhiyun x = 0;
669*4882a593Smuzhiyun y++;
670*4882a593Smuzhiyun }
671*4882a593Smuzhiyun }
672*4882a593Smuzhiyun }
673*4882a593Smuzhiyun return true;
674*4882a593Smuzhiyun }
675*4882a593Smuzhiyun
newport_save_screen(struct vc_data * vc)676*4882a593Smuzhiyun static void newport_save_screen(struct vc_data *vc) { }
677*4882a593Smuzhiyun
678*4882a593Smuzhiyun const struct consw newport_con = {
679*4882a593Smuzhiyun .owner = THIS_MODULE,
680*4882a593Smuzhiyun .con_startup = newport_startup,
681*4882a593Smuzhiyun .con_init = newport_init,
682*4882a593Smuzhiyun .con_deinit = newport_deinit,
683*4882a593Smuzhiyun .con_clear = newport_clear,
684*4882a593Smuzhiyun .con_putc = newport_putc,
685*4882a593Smuzhiyun .con_putcs = newport_putcs,
686*4882a593Smuzhiyun .con_cursor = newport_cursor,
687*4882a593Smuzhiyun .con_scroll = newport_scroll,
688*4882a593Smuzhiyun .con_switch = newport_switch,
689*4882a593Smuzhiyun .con_blank = newport_blank,
690*4882a593Smuzhiyun .con_font_set = newport_font_set,
691*4882a593Smuzhiyun .con_font_default = newport_font_default,
692*4882a593Smuzhiyun .con_save_screen = newport_save_screen
693*4882a593Smuzhiyun };
694*4882a593Smuzhiyun
newport_probe(struct gio_device * dev,const struct gio_device_id * id)695*4882a593Smuzhiyun static int newport_probe(struct gio_device *dev,
696*4882a593Smuzhiyun const struct gio_device_id *id)
697*4882a593Smuzhiyun {
698*4882a593Smuzhiyun int err;
699*4882a593Smuzhiyun
700*4882a593Smuzhiyun if (!dev->resource.start)
701*4882a593Smuzhiyun return -EINVAL;
702*4882a593Smuzhiyun
703*4882a593Smuzhiyun if (npregs)
704*4882a593Smuzhiyun return -EBUSY; /* we only support one Newport as console */
705*4882a593Smuzhiyun
706*4882a593Smuzhiyun newport_addr = dev->resource.start + 0xF0000;
707*4882a593Smuzhiyun if (!request_mem_region(newport_addr, NEWPORT_LEN, "Newport"))
708*4882a593Smuzhiyun return -ENODEV;
709*4882a593Smuzhiyun
710*4882a593Smuzhiyun npregs = (struct newport_regs *)/* ioremap cannot fail */
711*4882a593Smuzhiyun ioremap(newport_addr, sizeof(struct newport_regs));
712*4882a593Smuzhiyun console_lock();
713*4882a593Smuzhiyun err = do_take_over_console(&newport_con, 0, MAX_NR_CONSOLES - 1, 1);
714*4882a593Smuzhiyun console_unlock();
715*4882a593Smuzhiyun
716*4882a593Smuzhiyun if (err) {
717*4882a593Smuzhiyun iounmap((void *)npregs);
718*4882a593Smuzhiyun release_mem_region(newport_addr, NEWPORT_LEN);
719*4882a593Smuzhiyun }
720*4882a593Smuzhiyun return err;
721*4882a593Smuzhiyun }
722*4882a593Smuzhiyun
newport_remove(struct gio_device * dev)723*4882a593Smuzhiyun static void newport_remove(struct gio_device *dev)
724*4882a593Smuzhiyun {
725*4882a593Smuzhiyun give_up_console(&newport_con);
726*4882a593Smuzhiyun iounmap((void *)npregs);
727*4882a593Smuzhiyun release_mem_region(newport_addr, NEWPORT_LEN);
728*4882a593Smuzhiyun }
729*4882a593Smuzhiyun
730*4882a593Smuzhiyun static struct gio_device_id newport_ids[] = {
731*4882a593Smuzhiyun { .id = 0x7e },
732*4882a593Smuzhiyun { .id = 0xff }
733*4882a593Smuzhiyun };
734*4882a593Smuzhiyun
735*4882a593Smuzhiyun MODULE_ALIAS("gio:7e");
736*4882a593Smuzhiyun
737*4882a593Smuzhiyun static struct gio_driver newport_driver = {
738*4882a593Smuzhiyun .name = "newport",
739*4882a593Smuzhiyun .id_table = newport_ids,
740*4882a593Smuzhiyun .probe = newport_probe,
741*4882a593Smuzhiyun .remove = newport_remove,
742*4882a593Smuzhiyun };
743*4882a593Smuzhiyun module_driver(newport_driver, gio_register_driver, gio_unregister_driver);
744*4882a593Smuzhiyun
745*4882a593Smuzhiyun MODULE_LICENSE("GPL");
746