162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * newport_con.c: Abscon for newport hardware
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * (C) 1998 Thomas Bogendoerfer (tsbogend@alpha.franken.de)
662306a36Sopenharmony_ci * (C) 1999 Ulf Carlsson (ulfc@thepuffingruop.com)
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * This driver is based on sgicons.c and cons_newport.
962306a36Sopenharmony_ci *
1062306a36Sopenharmony_ci * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
1162306a36Sopenharmony_ci * Copyright (C) 1997 Miguel de Icaza (miguel@nuclecu.unam.mx)
1262306a36Sopenharmony_ci */
1362306a36Sopenharmony_ci#include <linux/init.h>
1462306a36Sopenharmony_ci#include <linux/kernel.h>
1562306a36Sopenharmony_ci#include <linux/errno.h>
1662306a36Sopenharmony_ci#include <linux/kd.h>
1762306a36Sopenharmony_ci#include <linux/selection.h>
1862306a36Sopenharmony_ci#include <linux/console.h>
1962306a36Sopenharmony_ci#include <linux/vt_kern.h>
2062306a36Sopenharmony_ci#include <linux/mm.h>
2162306a36Sopenharmony_ci#include <linux/module.h>
2262306a36Sopenharmony_ci#include <linux/slab.h>
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_ci#include <asm/io.h>
2562306a36Sopenharmony_ci#include <linux/uaccess.h>
2662306a36Sopenharmony_ci#include <asm/page.h>
2762306a36Sopenharmony_ci#include <asm/gio_device.h>
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci#include <video/newport.h>
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci#include <linux/linux_logo.h>
3262306a36Sopenharmony_ci#include <linux/font.h>
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci#define NEWPORT_LEN	0x10000
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci#define FONT_DATA ((unsigned char *)font_vga_8x16.data)
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_cistatic unsigned char *font_data[MAX_NR_CONSOLES];
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_cistatic struct newport_regs *npregs;
4162306a36Sopenharmony_cistatic unsigned long newport_addr;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic int logo_active;
4462306a36Sopenharmony_cistatic int topscan;
4562306a36Sopenharmony_cistatic int xcurs_correction = 29;
4662306a36Sopenharmony_cistatic int newport_xsize;
4762306a36Sopenharmony_cistatic int newport_ysize;
4862306a36Sopenharmony_cistatic int newport_has_init;
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic int newport_set_def_font(int unit, struct console_font *op);
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_ci#define BMASK(c) (c << 24)
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci#define RENDER(regs, cp) do { \
5562306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0x0]); (regs)->go.zpattern = BMASK((cp)[0x1]); \
5662306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0x2]); (regs)->go.zpattern = BMASK((cp)[0x3]); \
5762306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0x4]); (regs)->go.zpattern = BMASK((cp)[0x5]); \
5862306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0x6]); (regs)->go.zpattern = BMASK((cp)[0x7]); \
5962306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0x8]); (regs)->go.zpattern = BMASK((cp)[0x9]); \
6062306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0xa]); (regs)->go.zpattern = BMASK((cp)[0xb]); \
6162306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0xc]); (regs)->go.zpattern = BMASK((cp)[0xd]); \
6262306a36Sopenharmony_ci(regs)->go.zpattern = BMASK((cp)[0xe]); (regs)->go.zpattern = BMASK((cp)[0xf]); \
6362306a36Sopenharmony_ci} while(0)
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci#define TESTVAL 0xdeadbeef
6662306a36Sopenharmony_ci#define XSTI_TO_FXSTART(val) (((val) & 0xffff) << 11)
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_cistatic inline void newport_render_background(int xstart, int ystart,
6962306a36Sopenharmony_ci					     int xend, int yend, int ci)
7062306a36Sopenharmony_ci{
7162306a36Sopenharmony_ci	newport_wait(npregs);
7262306a36Sopenharmony_ci	npregs->set.wrmask = 0xffffffff;
7362306a36Sopenharmony_ci	npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
7462306a36Sopenharmony_ci				 NPORT_DMODE0_DOSETUP | NPORT_DMODE0_STOPX
7562306a36Sopenharmony_ci				 | NPORT_DMODE0_STOPY);
7662306a36Sopenharmony_ci	npregs->set.colori = ci;
7762306a36Sopenharmony_ci	npregs->set.xystarti =
7862306a36Sopenharmony_ci	    (xstart << 16) | ((ystart + topscan) & 0x3ff);
7962306a36Sopenharmony_ci	npregs->go.xyendi =
8062306a36Sopenharmony_ci	    ((xend + 7) << 16) | ((yend + topscan + 15) & 0x3ff);
8162306a36Sopenharmony_ci}
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_cistatic inline void newport_init_cmap(void)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	unsigned short i;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	for (i = 0; i < 16; i++) {
8862306a36Sopenharmony_ci		newport_bfwait(npregs);
8962306a36Sopenharmony_ci		newport_cmap_setaddr(npregs, color_table[i]);
9062306a36Sopenharmony_ci		newport_cmap_setrgb(npregs,
9162306a36Sopenharmony_ci				    default_red[i],
9262306a36Sopenharmony_ci				    default_grn[i], default_blu[i]);
9362306a36Sopenharmony_ci	}
9462306a36Sopenharmony_ci}
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_cistatic const struct linux_logo *newport_show_logo(void)
9762306a36Sopenharmony_ci{
9862306a36Sopenharmony_ci#ifdef CONFIG_LOGO_SGI_CLUT224
9962306a36Sopenharmony_ci	const struct linux_logo *logo = fb_find_logo(8);
10062306a36Sopenharmony_ci	const unsigned char *clut;
10162306a36Sopenharmony_ci	const unsigned char *data;
10262306a36Sopenharmony_ci	unsigned long i;
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	if (!logo)
10562306a36Sopenharmony_ci		return NULL;
10662306a36Sopenharmony_ci	clut = logo->clut;
10762306a36Sopenharmony_ci	data = logo->data;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	for (i = 0; i < logo->clutsize; i++) {
11062306a36Sopenharmony_ci		newport_bfwait(npregs);
11162306a36Sopenharmony_ci		newport_cmap_setaddr(npregs, i + 0x20);
11262306a36Sopenharmony_ci		newport_cmap_setrgb(npregs, clut[0], clut[1], clut[2]);
11362306a36Sopenharmony_ci		clut += 3;
11462306a36Sopenharmony_ci	}
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_ci	newport_wait(npregs);
11762306a36Sopenharmony_ci	npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
11862306a36Sopenharmony_ci				 NPORT_DMODE0_CHOST);
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	npregs->set.xystarti = ((newport_xsize - logo->width) << 16) | (0);
12162306a36Sopenharmony_ci	npregs->set.xyendi = ((newport_xsize - 1) << 16);
12262306a36Sopenharmony_ci	newport_wait(npregs);
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	for (i = 0; i < logo->width*logo->height; i++)
12562306a36Sopenharmony_ci		npregs->go.hostrw0 = *data++ << 24;
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	return logo;
12862306a36Sopenharmony_ci#else
12962306a36Sopenharmony_ci	return NULL;
13062306a36Sopenharmony_ci#endif /* CONFIG_LOGO_SGI_CLUT224 */
13162306a36Sopenharmony_ci}
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_cistatic inline void newport_clear_screen(int xstart, int ystart, int xend,
13462306a36Sopenharmony_ci					int yend, int ci)
13562306a36Sopenharmony_ci{
13662306a36Sopenharmony_ci	if (logo_active)
13762306a36Sopenharmony_ci		return;
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	newport_wait(npregs);
14062306a36Sopenharmony_ci	npregs->set.wrmask = 0xffffffff;
14162306a36Sopenharmony_ci	npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
14262306a36Sopenharmony_ci				 NPORT_DMODE0_DOSETUP | NPORT_DMODE0_STOPX
14362306a36Sopenharmony_ci				 | NPORT_DMODE0_STOPY);
14462306a36Sopenharmony_ci	npregs->set.colori = ci;
14562306a36Sopenharmony_ci	npregs->set.xystarti = (xstart << 16) | ystart;
14662306a36Sopenharmony_ci	npregs->go.xyendi = (xend << 16) | yend;
14762306a36Sopenharmony_ci}
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_cistatic inline void newport_clear_lines(int ystart, int yend, int ci)
15062306a36Sopenharmony_ci{
15162306a36Sopenharmony_ci	ystart = ((ystart << 4) + topscan) & 0x3ff;
15262306a36Sopenharmony_ci	yend = ((yend << 4) + topscan + 15) & 0x3ff;
15362306a36Sopenharmony_ci	newport_clear_screen(0, ystart, 1280 + 63, yend, ci);
15462306a36Sopenharmony_ci}
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_cistatic void newport_reset(void)
15762306a36Sopenharmony_ci{
15862306a36Sopenharmony_ci	unsigned short treg;
15962306a36Sopenharmony_ci	int i;
16062306a36Sopenharmony_ci
16162306a36Sopenharmony_ci	newport_wait(npregs);
16262306a36Sopenharmony_ci	treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
16362306a36Sopenharmony_ci	newport_vc2_set(npregs, VC2_IREG_CONTROL,
16462306a36Sopenharmony_ci			(treg | VC2_CTRL_EVIDEO));
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	treg = newport_vc2_get(npregs, VC2_IREG_CENTRY);
16762306a36Sopenharmony_ci	newport_vc2_set(npregs, VC2_IREG_RADDR, treg);
16862306a36Sopenharmony_ci	npregs->set.dcbmode = (NPORT_DMODE_AVC2 | VC2_REGADDR_RAM |
16962306a36Sopenharmony_ci			       NPORT_DMODE_W2 | VC2_PROTOCOL);
17062306a36Sopenharmony_ci	for (i = 0; i < 128; i++) {
17162306a36Sopenharmony_ci		newport_bfwait(npregs);
17262306a36Sopenharmony_ci		if (i == 92 || i == 94)
17362306a36Sopenharmony_ci			npregs->set.dcbdata0.byshort.s1 = 0xff00;
17462306a36Sopenharmony_ci		else
17562306a36Sopenharmony_ci			npregs->set.dcbdata0.byshort.s1 = 0x0000;
17662306a36Sopenharmony_ci	}
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	newport_init_cmap();
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci	/* turn off popup plane */
18162306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_XMAP0 | R_DCB_XMAP9_PROTOCOL |
18262306a36Sopenharmony_ci			       XM9_CRS_CONFIG | NPORT_DMODE_W1);
18362306a36Sopenharmony_ci	npregs->set.dcbdata0.bybytes.b3 &= ~XM9_PUPMODE;
18462306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_XMAP1 | R_DCB_XMAP9_PROTOCOL |
18562306a36Sopenharmony_ci			       XM9_CRS_CONFIG | NPORT_DMODE_W1);
18662306a36Sopenharmony_ci	npregs->set.dcbdata0.bybytes.b3 &= ~XM9_PUPMODE;
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	topscan = 0;
18962306a36Sopenharmony_ci	npregs->cset.topscan = 0x3ff;
19062306a36Sopenharmony_ci	npregs->cset.xywin = (4096 << 16) | 4096;
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci	/* Clear the screen. */
19362306a36Sopenharmony_ci	newport_clear_screen(0, 0, 1280 + 63, 1024, 0);
19462306a36Sopenharmony_ci}
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci/*
19762306a36Sopenharmony_ci * calculate the actual screen size by reading
19862306a36Sopenharmony_ci * the video timing out of the VC2
19962306a36Sopenharmony_ci */
20062306a36Sopenharmony_cistatic void newport_get_screensize(void)
20162306a36Sopenharmony_ci{
20262306a36Sopenharmony_ci	int i, cols;
20362306a36Sopenharmony_ci	unsigned short ventry, treg;
20462306a36Sopenharmony_ci	unsigned short linetable[128];	/* should be enough */
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	ventry = newport_vc2_get(npregs, VC2_IREG_VENTRY);
20762306a36Sopenharmony_ci	newport_vc2_set(npregs, VC2_IREG_RADDR, ventry);
20862306a36Sopenharmony_ci	npregs->set.dcbmode = (NPORT_DMODE_AVC2 | VC2_REGADDR_RAM |
20962306a36Sopenharmony_ci			       NPORT_DMODE_W2 | VC2_PROTOCOL);
21062306a36Sopenharmony_ci	for (i = 0; i < 128; i++) {
21162306a36Sopenharmony_ci		newport_bfwait(npregs);
21262306a36Sopenharmony_ci		linetable[i] = npregs->set.dcbdata0.byshort.s1;
21362306a36Sopenharmony_ci	}
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	newport_xsize = newport_ysize = 0;
21662306a36Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(linetable) - 1 && linetable[i + 1]; i += 2) {
21762306a36Sopenharmony_ci		cols = 0;
21862306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_RADDR, linetable[i]);
21962306a36Sopenharmony_ci		npregs->set.dcbmode = (NPORT_DMODE_AVC2 | VC2_REGADDR_RAM |
22062306a36Sopenharmony_ci				       NPORT_DMODE_W2 | VC2_PROTOCOL);
22162306a36Sopenharmony_ci		do {
22262306a36Sopenharmony_ci			newport_bfwait(npregs);
22362306a36Sopenharmony_ci			treg = npregs->set.dcbdata0.byshort.s1;
22462306a36Sopenharmony_ci			if ((treg & 1) == 0)
22562306a36Sopenharmony_ci				cols += (treg >> 7) & 0xfe;
22662306a36Sopenharmony_ci			if ((treg & 0x80) == 0) {
22762306a36Sopenharmony_ci				newport_bfwait(npregs);
22862306a36Sopenharmony_ci				treg = npregs->set.dcbdata0.byshort.s1;
22962306a36Sopenharmony_ci			}
23062306a36Sopenharmony_ci		} while ((treg & 0x8000) == 0);
23162306a36Sopenharmony_ci		if (cols) {
23262306a36Sopenharmony_ci			if (cols > newport_xsize)
23362306a36Sopenharmony_ci				newport_xsize = cols;
23462306a36Sopenharmony_ci			newport_ysize += linetable[i + 1];
23562306a36Sopenharmony_ci		}
23662306a36Sopenharmony_ci	}
23762306a36Sopenharmony_ci	printk("NG1: Screensize %dx%d\n", newport_xsize, newport_ysize);
23862306a36Sopenharmony_ci}
23962306a36Sopenharmony_ci
24062306a36Sopenharmony_cistatic void newport_get_revisions(void)
24162306a36Sopenharmony_ci{
24262306a36Sopenharmony_ci	unsigned int tmp;
24362306a36Sopenharmony_ci	unsigned int board_rev;
24462306a36Sopenharmony_ci	unsigned int rex3_rev;
24562306a36Sopenharmony_ci	unsigned int vc2_rev;
24662306a36Sopenharmony_ci	unsigned int cmap_rev;
24762306a36Sopenharmony_ci	unsigned int xmap9_rev;
24862306a36Sopenharmony_ci	unsigned int bt445_rev;
24962306a36Sopenharmony_ci	unsigned int bitplanes;
25062306a36Sopenharmony_ci
25162306a36Sopenharmony_ci	rex3_rev = npregs->cset.status & NPORT_STAT_VERS;
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_CMAP0 | NCMAP_PROTOCOL |
25462306a36Sopenharmony_ci			       NCMAP_REGADDR_RREG | NPORT_DMODE_W1);
25562306a36Sopenharmony_ci	tmp = npregs->set.dcbdata0.bybytes.b3;
25662306a36Sopenharmony_ci	cmap_rev = tmp & 7;
25762306a36Sopenharmony_ci	board_rev = (tmp >> 4) & 7;
25862306a36Sopenharmony_ci	bitplanes = ((board_rev > 1) && (tmp & 0x80)) ? 8 : 24;
25962306a36Sopenharmony_ci
26062306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_CMAP1 | NCMAP_PROTOCOL |
26162306a36Sopenharmony_ci			       NCMAP_REGADDR_RREG | NPORT_DMODE_W1);
26262306a36Sopenharmony_ci	tmp = npregs->set.dcbdata0.bybytes.b3;
26362306a36Sopenharmony_ci	if ((tmp & 7) < cmap_rev)
26462306a36Sopenharmony_ci		cmap_rev = (tmp & 7);
26562306a36Sopenharmony_ci
26662306a36Sopenharmony_ci	vc2_rev = (newport_vc2_get(npregs, VC2_IREG_CONFIG) >> 5) & 7;
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_XMAP0 | R_DCB_XMAP9_PROTOCOL |
26962306a36Sopenharmony_ci			       XM9_CRS_REVISION | NPORT_DMODE_W1);
27062306a36Sopenharmony_ci	xmap9_rev = npregs->set.dcbdata0.bybytes.b3 & 7;
27162306a36Sopenharmony_ci
27262306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_BT445 | BT445_PROTOCOL |
27362306a36Sopenharmony_ci			       BT445_CSR_ADDR_REG | NPORT_DMODE_W1);
27462306a36Sopenharmony_ci	npregs->set.dcbdata0.bybytes.b3 = BT445_REVISION_REG;
27562306a36Sopenharmony_ci	npregs->set.dcbmode = (DCB_BT445 | BT445_PROTOCOL |
27662306a36Sopenharmony_ci			       BT445_CSR_REVISION | NPORT_DMODE_W1);
27762306a36Sopenharmony_ci	bt445_rev = (npregs->set.dcbdata0.bybytes.b3 >> 4) - 0x0a;
27862306a36Sopenharmony_ci
27962306a36Sopenharmony_ci#define L(a)     (char)('A'+(a))
28062306a36Sopenharmony_ci	printk
28162306a36Sopenharmony_ci	    ("NG1: Revision %d, %d bitplanes, REX3 revision %c, VC2 revision %c, xmap9 revision %c, cmap revision %c, bt445 revision %c\n",
28262306a36Sopenharmony_ci	     board_rev, bitplanes, L(rex3_rev), L(vc2_rev), L(xmap9_rev),
28362306a36Sopenharmony_ci	     L(cmap_rev ? (cmap_rev + 1) : 0), L(bt445_rev));
28462306a36Sopenharmony_ci#undef L
28562306a36Sopenharmony_ci
28662306a36Sopenharmony_ci	if (board_rev == 3)	/* I don't know all affected revisions */
28762306a36Sopenharmony_ci		xcurs_correction = 21;
28862306a36Sopenharmony_ci}
28962306a36Sopenharmony_ci
29062306a36Sopenharmony_cistatic void newport_exit(void)
29162306a36Sopenharmony_ci{
29262306a36Sopenharmony_ci	int i;
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci	/* free memory used by user font */
29562306a36Sopenharmony_ci	for (i = 0; i < MAX_NR_CONSOLES; i++)
29662306a36Sopenharmony_ci		newport_set_def_font(i, NULL);
29762306a36Sopenharmony_ci}
29862306a36Sopenharmony_ci
29962306a36Sopenharmony_ci/* Can't be __init, do_take_over_console may call it later */
30062306a36Sopenharmony_cistatic const char *newport_startup(void)
30162306a36Sopenharmony_ci{
30262306a36Sopenharmony_ci	int i;
30362306a36Sopenharmony_ci
30462306a36Sopenharmony_ci	npregs->cset.config = NPORT_CFG_GD0;
30562306a36Sopenharmony_ci
30662306a36Sopenharmony_ci	if (newport_wait(npregs))
30762306a36Sopenharmony_ci		goto out_unmap;
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_ci	npregs->set.xstarti = TESTVAL;
31062306a36Sopenharmony_ci	if (npregs->set._xstart.word != XSTI_TO_FXSTART(TESTVAL))
31162306a36Sopenharmony_ci		goto out_unmap;
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_ci	for (i = 0; i < MAX_NR_CONSOLES; i++)
31462306a36Sopenharmony_ci		font_data[i] = FONT_DATA;
31562306a36Sopenharmony_ci
31662306a36Sopenharmony_ci	newport_reset();
31762306a36Sopenharmony_ci	newport_get_revisions();
31862306a36Sopenharmony_ci	newport_get_screensize();
31962306a36Sopenharmony_ci	newport_has_init = 1;
32062306a36Sopenharmony_ci
32162306a36Sopenharmony_ci	return "SGI Newport";
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ciout_unmap:
32462306a36Sopenharmony_ci	return NULL;
32562306a36Sopenharmony_ci}
32662306a36Sopenharmony_ci
32762306a36Sopenharmony_cistatic void newport_init(struct vc_data *vc, int init)
32862306a36Sopenharmony_ci{
32962306a36Sopenharmony_ci	int cols, rows;
33062306a36Sopenharmony_ci
33162306a36Sopenharmony_ci	cols = newport_xsize / 8;
33262306a36Sopenharmony_ci	rows = newport_ysize / 16;
33362306a36Sopenharmony_ci	vc->vc_can_do_color = 1;
33462306a36Sopenharmony_ci	if (init) {
33562306a36Sopenharmony_ci		vc->vc_cols = cols;
33662306a36Sopenharmony_ci		vc->vc_rows = rows;
33762306a36Sopenharmony_ci	} else
33862306a36Sopenharmony_ci		vc_resize(vc, cols, rows);
33962306a36Sopenharmony_ci}
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_cistatic void newport_deinit(struct vc_data *c)
34262306a36Sopenharmony_ci{
34362306a36Sopenharmony_ci	if (!con_is_bound(&newport_con) && newport_has_init) {
34462306a36Sopenharmony_ci		newport_exit();
34562306a36Sopenharmony_ci		newport_has_init = 0;
34662306a36Sopenharmony_ci	}
34762306a36Sopenharmony_ci}
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_cistatic void newport_clear(struct vc_data *vc, int sy, int sx, int height,
35062306a36Sopenharmony_ci			  int width)
35162306a36Sopenharmony_ci{
35262306a36Sopenharmony_ci	int xend = ((sx + width) << 3) - 1;
35362306a36Sopenharmony_ci	int ystart = ((sy << 4) + topscan) & 0x3ff;
35462306a36Sopenharmony_ci	int yend = (((sy + height) << 4) + topscan - 1) & 0x3ff;
35562306a36Sopenharmony_ci
35662306a36Sopenharmony_ci	if (logo_active)
35762306a36Sopenharmony_ci		return;
35862306a36Sopenharmony_ci
35962306a36Sopenharmony_ci	if (ystart < yend) {
36062306a36Sopenharmony_ci		newport_clear_screen(sx << 3, ystart, xend, yend,
36162306a36Sopenharmony_ci				     (vc->state.color & 0xf0) >> 4);
36262306a36Sopenharmony_ci	} else {
36362306a36Sopenharmony_ci		newport_clear_screen(sx << 3, ystart, xend, 1023,
36462306a36Sopenharmony_ci				     (vc->state.color & 0xf0) >> 4);
36562306a36Sopenharmony_ci		newport_clear_screen(sx << 3, 0, xend, yend,
36662306a36Sopenharmony_ci				     (vc->state.color & 0xf0) >> 4);
36762306a36Sopenharmony_ci	}
36862306a36Sopenharmony_ci}
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_cistatic void newport_putc(struct vc_data *vc, int charattr, int ypos,
37162306a36Sopenharmony_ci			 int xpos)
37262306a36Sopenharmony_ci{
37362306a36Sopenharmony_ci	unsigned char *p;
37462306a36Sopenharmony_ci
37562306a36Sopenharmony_ci	p = &font_data[vc->vc_num][(charattr & 0xff) << 4];
37662306a36Sopenharmony_ci	charattr = (charattr >> 8) & 0xff;
37762306a36Sopenharmony_ci	xpos <<= 3;
37862306a36Sopenharmony_ci	ypos <<= 4;
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_ci	newport_render_background(xpos, ypos, xpos, ypos,
38162306a36Sopenharmony_ci				  (charattr & 0xf0) >> 4);
38262306a36Sopenharmony_ci
38362306a36Sopenharmony_ci	/* Set the color and drawing mode. */
38462306a36Sopenharmony_ci	newport_wait(npregs);
38562306a36Sopenharmony_ci	npregs->set.colori = charattr & 0xf;
38662306a36Sopenharmony_ci	npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
38762306a36Sopenharmony_ci				 NPORT_DMODE0_STOPX | NPORT_DMODE0_ZPENAB |
38862306a36Sopenharmony_ci				 NPORT_DMODE0_L32);
38962306a36Sopenharmony_ci
39062306a36Sopenharmony_ci	/* Set coordinates for bitmap operation. */
39162306a36Sopenharmony_ci	npregs->set.xystarti = (xpos << 16) | ((ypos + topscan) & 0x3ff);
39262306a36Sopenharmony_ci	npregs->set.xyendi = ((xpos + 7) << 16);
39362306a36Sopenharmony_ci	newport_wait(npregs);
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_ci	/* Go, baby, go... */
39662306a36Sopenharmony_ci	RENDER(npregs, p);
39762306a36Sopenharmony_ci}
39862306a36Sopenharmony_ci
39962306a36Sopenharmony_cistatic void newport_putcs(struct vc_data *vc, const unsigned short *s,
40062306a36Sopenharmony_ci			  int count, int ypos, int xpos)
40162306a36Sopenharmony_ci{
40262306a36Sopenharmony_ci	int i;
40362306a36Sopenharmony_ci	int charattr;
40462306a36Sopenharmony_ci	unsigned char *p;
40562306a36Sopenharmony_ci
40662306a36Sopenharmony_ci	charattr = (scr_readw(s) >> 8) & 0xff;
40762306a36Sopenharmony_ci
40862306a36Sopenharmony_ci	xpos <<= 3;
40962306a36Sopenharmony_ci	ypos <<= 4;
41062306a36Sopenharmony_ci
41162306a36Sopenharmony_ci	if (!logo_active)
41262306a36Sopenharmony_ci		/* Clear the area behing the string */
41362306a36Sopenharmony_ci		newport_render_background(xpos, ypos,
41462306a36Sopenharmony_ci					  xpos + ((count - 1) << 3), ypos,
41562306a36Sopenharmony_ci					  (charattr & 0xf0) >> 4);
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ci	newport_wait(npregs);
41862306a36Sopenharmony_ci
41962306a36Sopenharmony_ci	/* Set the color and drawing mode. */
42062306a36Sopenharmony_ci	npregs->set.colori = charattr & 0xf;
42162306a36Sopenharmony_ci	npregs->set.drawmode0 = (NPORT_DMODE0_DRAW | NPORT_DMODE0_BLOCK |
42262306a36Sopenharmony_ci				 NPORT_DMODE0_STOPX | NPORT_DMODE0_ZPENAB |
42362306a36Sopenharmony_ci				 NPORT_DMODE0_L32);
42462306a36Sopenharmony_ci
42562306a36Sopenharmony_ci	for (i = 0; i < count; i++, xpos += 8) {
42662306a36Sopenharmony_ci		p = &font_data[vc->vc_num][(scr_readw(s++) & 0xff) << 4];
42762306a36Sopenharmony_ci
42862306a36Sopenharmony_ci		newport_wait(npregs);
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_ci		/* Set coordinates for bitmap operation. */
43162306a36Sopenharmony_ci		npregs->set.xystarti =
43262306a36Sopenharmony_ci		    (xpos << 16) | ((ypos + topscan) & 0x3ff);
43362306a36Sopenharmony_ci		npregs->set.xyendi = ((xpos + 7) << 16);
43462306a36Sopenharmony_ci
43562306a36Sopenharmony_ci		/* Go, baby, go... */
43662306a36Sopenharmony_ci		RENDER(npregs, p);
43762306a36Sopenharmony_ci	}
43862306a36Sopenharmony_ci}
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_cistatic void newport_cursor(struct vc_data *vc, int mode)
44162306a36Sopenharmony_ci{
44262306a36Sopenharmony_ci	unsigned short treg;
44362306a36Sopenharmony_ci	int xcurs, ycurs;
44462306a36Sopenharmony_ci
44562306a36Sopenharmony_ci	switch (mode) {
44662306a36Sopenharmony_ci	case CM_ERASE:
44762306a36Sopenharmony_ci		treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
44862306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_CONTROL,
44962306a36Sopenharmony_ci				(treg & ~(VC2_CTRL_ECDISP)));
45062306a36Sopenharmony_ci		break;
45162306a36Sopenharmony_ci
45262306a36Sopenharmony_ci	case CM_MOVE:
45362306a36Sopenharmony_ci	case CM_DRAW:
45462306a36Sopenharmony_ci		treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
45562306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_CONTROL,
45662306a36Sopenharmony_ci				(treg | VC2_CTRL_ECDISP));
45762306a36Sopenharmony_ci		xcurs = (vc->vc_pos - vc->vc_visible_origin) / 2;
45862306a36Sopenharmony_ci		ycurs = ((xcurs / vc->vc_cols) << 4) + 31;
45962306a36Sopenharmony_ci		xcurs = ((xcurs % vc->vc_cols) << 3) + xcurs_correction;
46062306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_CURSX, xcurs);
46162306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_CURSY, ycurs);
46262306a36Sopenharmony_ci	}
46362306a36Sopenharmony_ci}
46462306a36Sopenharmony_ci
46562306a36Sopenharmony_cistatic int newport_switch(struct vc_data *vc)
46662306a36Sopenharmony_ci{
46762306a36Sopenharmony_ci	static int logo_drawn = 0;
46862306a36Sopenharmony_ci
46962306a36Sopenharmony_ci	topscan = 0;
47062306a36Sopenharmony_ci	npregs->cset.topscan = 0x3ff;
47162306a36Sopenharmony_ci
47262306a36Sopenharmony_ci	if (!logo_drawn) {
47362306a36Sopenharmony_ci		if (newport_show_logo()) {
47462306a36Sopenharmony_ci			logo_drawn = 1;
47562306a36Sopenharmony_ci			logo_active = 1;
47662306a36Sopenharmony_ci		}
47762306a36Sopenharmony_ci	}
47862306a36Sopenharmony_ci
47962306a36Sopenharmony_ci	return 1;
48062306a36Sopenharmony_ci}
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_cistatic int newport_blank(struct vc_data *c, int blank, int mode_switch)
48362306a36Sopenharmony_ci{
48462306a36Sopenharmony_ci	unsigned short treg;
48562306a36Sopenharmony_ci
48662306a36Sopenharmony_ci	if (blank == 0) {
48762306a36Sopenharmony_ci		/* unblank console */
48862306a36Sopenharmony_ci		treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
48962306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_CONTROL,
49062306a36Sopenharmony_ci				(treg | VC2_CTRL_EDISP));
49162306a36Sopenharmony_ci	} else {
49262306a36Sopenharmony_ci		/* blank console */
49362306a36Sopenharmony_ci		treg = newport_vc2_get(npregs, VC2_IREG_CONTROL);
49462306a36Sopenharmony_ci		newport_vc2_set(npregs, VC2_IREG_CONTROL,
49562306a36Sopenharmony_ci				(treg & ~(VC2_CTRL_EDISP)));
49662306a36Sopenharmony_ci	}
49762306a36Sopenharmony_ci	return 1;
49862306a36Sopenharmony_ci}
49962306a36Sopenharmony_ci
50062306a36Sopenharmony_cistatic int newport_set_font(int unit, struct console_font *op, unsigned int vpitch)
50162306a36Sopenharmony_ci{
50262306a36Sopenharmony_ci	int w = op->width;
50362306a36Sopenharmony_ci	int h = op->height;
50462306a36Sopenharmony_ci	int size = h * op->charcount;
50562306a36Sopenharmony_ci	int i;
50662306a36Sopenharmony_ci	unsigned char *new_data, *data = op->data, *p;
50762306a36Sopenharmony_ci
50862306a36Sopenharmony_ci	/* ladis: when I grow up, there will be a day... and more sizes will
50962306a36Sopenharmony_ci	 * be supported ;-) */
51062306a36Sopenharmony_ci	if ((w != 8) || (h != 16) || (vpitch != 32)
51162306a36Sopenharmony_ci	    || (op->charcount != 256 && op->charcount != 512))
51262306a36Sopenharmony_ci		return -EINVAL;
51362306a36Sopenharmony_ci
51462306a36Sopenharmony_ci	if (!(new_data = kmalloc(FONT_EXTRA_WORDS * sizeof(int) + size,
51562306a36Sopenharmony_ci	     GFP_USER))) return -ENOMEM;
51662306a36Sopenharmony_ci
51762306a36Sopenharmony_ci	new_data += FONT_EXTRA_WORDS * sizeof(int);
51862306a36Sopenharmony_ci	FNTSIZE(new_data) = size;
51962306a36Sopenharmony_ci	FNTCHARCNT(new_data) = op->charcount;
52062306a36Sopenharmony_ci	REFCOUNT(new_data) = 0;	/* usage counter */
52162306a36Sopenharmony_ci	FNTSUM(new_data) = 0;
52262306a36Sopenharmony_ci
52362306a36Sopenharmony_ci	p = new_data;
52462306a36Sopenharmony_ci	for (i = 0; i < op->charcount; i++) {
52562306a36Sopenharmony_ci		memcpy(p, data, h);
52662306a36Sopenharmony_ci		data += 32;
52762306a36Sopenharmony_ci		p += h;
52862306a36Sopenharmony_ci	}
52962306a36Sopenharmony_ci
53062306a36Sopenharmony_ci	/* check if font is already used by other console */
53162306a36Sopenharmony_ci	for (i = 0; i < MAX_NR_CONSOLES; i++) {
53262306a36Sopenharmony_ci		if (font_data[i] != FONT_DATA
53362306a36Sopenharmony_ci		    && FNTSIZE(font_data[i]) == size
53462306a36Sopenharmony_ci		    && !memcmp(font_data[i], new_data, size)) {
53562306a36Sopenharmony_ci			kfree(new_data - FONT_EXTRA_WORDS * sizeof(int));
53662306a36Sopenharmony_ci			/* current font is the same as the new one */
53762306a36Sopenharmony_ci			if (i == unit)
53862306a36Sopenharmony_ci				return 0;
53962306a36Sopenharmony_ci			new_data = font_data[i];
54062306a36Sopenharmony_ci			break;
54162306a36Sopenharmony_ci		}
54262306a36Sopenharmony_ci	}
54362306a36Sopenharmony_ci	/* old font is user font */
54462306a36Sopenharmony_ci	if (font_data[unit] != FONT_DATA) {
54562306a36Sopenharmony_ci		if (--REFCOUNT(font_data[unit]) == 0)
54662306a36Sopenharmony_ci			kfree(font_data[unit] -
54762306a36Sopenharmony_ci			      FONT_EXTRA_WORDS * sizeof(int));
54862306a36Sopenharmony_ci	}
54962306a36Sopenharmony_ci	REFCOUNT(new_data)++;
55062306a36Sopenharmony_ci	font_data[unit] = new_data;
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	return 0;
55362306a36Sopenharmony_ci}
55462306a36Sopenharmony_ci
55562306a36Sopenharmony_cistatic int newport_set_def_font(int unit, struct console_font *op)
55662306a36Sopenharmony_ci{
55762306a36Sopenharmony_ci	if (font_data[unit] != FONT_DATA) {
55862306a36Sopenharmony_ci		if (--REFCOUNT(font_data[unit]) == 0)
55962306a36Sopenharmony_ci			kfree(font_data[unit] -
56062306a36Sopenharmony_ci			      FONT_EXTRA_WORDS * sizeof(int));
56162306a36Sopenharmony_ci		font_data[unit] = FONT_DATA;
56262306a36Sopenharmony_ci	}
56362306a36Sopenharmony_ci
56462306a36Sopenharmony_ci	return 0;
56562306a36Sopenharmony_ci}
56662306a36Sopenharmony_ci
56762306a36Sopenharmony_cistatic int newport_font_default(struct vc_data *vc, struct console_font *op, char *name)
56862306a36Sopenharmony_ci{
56962306a36Sopenharmony_ci	return newport_set_def_font(vc->vc_num, op);
57062306a36Sopenharmony_ci}
57162306a36Sopenharmony_ci
57262306a36Sopenharmony_cistatic int newport_font_set(struct vc_data *vc, struct console_font *font,
57362306a36Sopenharmony_ci			    unsigned int vpitch, unsigned int flags)
57462306a36Sopenharmony_ci{
57562306a36Sopenharmony_ci	return newport_set_font(vc->vc_num, font, vpitch);
57662306a36Sopenharmony_ci}
57762306a36Sopenharmony_ci
57862306a36Sopenharmony_cistatic bool newport_scroll(struct vc_data *vc, unsigned int t, unsigned int b,
57962306a36Sopenharmony_ci		enum con_scroll dir, unsigned int lines)
58062306a36Sopenharmony_ci{
58162306a36Sopenharmony_ci	int count, x, y;
58262306a36Sopenharmony_ci	unsigned short *s, *d;
58362306a36Sopenharmony_ci	unsigned short chattr;
58462306a36Sopenharmony_ci
58562306a36Sopenharmony_ci	logo_active = 0;	/* it's time to disable the logo now.. */
58662306a36Sopenharmony_ci
58762306a36Sopenharmony_ci	if (t == 0 && b == vc->vc_rows) {
58862306a36Sopenharmony_ci		if (dir == SM_UP) {
58962306a36Sopenharmony_ci			topscan = (topscan + (lines << 4)) & 0x3ff;
59062306a36Sopenharmony_ci			newport_clear_lines(vc->vc_rows - lines,
59162306a36Sopenharmony_ci					    vc->vc_rows - 1,
59262306a36Sopenharmony_ci					    (vc->state.color & 0xf0) >> 4);
59362306a36Sopenharmony_ci		} else {
59462306a36Sopenharmony_ci			topscan = (topscan + (-lines << 4)) & 0x3ff;
59562306a36Sopenharmony_ci			newport_clear_lines(0, lines - 1,
59662306a36Sopenharmony_ci					    (vc->state.color & 0xf0) >> 4);
59762306a36Sopenharmony_ci		}
59862306a36Sopenharmony_ci		npregs->cset.topscan = (topscan - 1) & 0x3ff;
59962306a36Sopenharmony_ci		return false;
60062306a36Sopenharmony_ci	}
60162306a36Sopenharmony_ci
60262306a36Sopenharmony_ci	count = (b - t - lines) * vc->vc_cols;
60362306a36Sopenharmony_ci	if (dir == SM_UP) {
60462306a36Sopenharmony_ci		x = 0;
60562306a36Sopenharmony_ci		y = t;
60662306a36Sopenharmony_ci		s = (unsigned short *) (vc->vc_origin +
60762306a36Sopenharmony_ci					vc->vc_size_row * (t + lines));
60862306a36Sopenharmony_ci		d = (unsigned short *) (vc->vc_origin +
60962306a36Sopenharmony_ci					vc->vc_size_row * t);
61062306a36Sopenharmony_ci		while (count--) {
61162306a36Sopenharmony_ci			chattr = scr_readw(s++);
61262306a36Sopenharmony_ci			if (chattr != scr_readw(d)) {
61362306a36Sopenharmony_ci				newport_putc(vc, chattr, y, x);
61462306a36Sopenharmony_ci				scr_writew(chattr, d);
61562306a36Sopenharmony_ci			}
61662306a36Sopenharmony_ci			d++;
61762306a36Sopenharmony_ci			if (++x == vc->vc_cols) {
61862306a36Sopenharmony_ci				x = 0;
61962306a36Sopenharmony_ci				y++;
62062306a36Sopenharmony_ci			}
62162306a36Sopenharmony_ci		}
62262306a36Sopenharmony_ci		d = (unsigned short *) (vc->vc_origin +
62362306a36Sopenharmony_ci					vc->vc_size_row * (b - lines));
62462306a36Sopenharmony_ci		x = 0;
62562306a36Sopenharmony_ci		y = b - lines;
62662306a36Sopenharmony_ci		for (count = 0; count < (lines * vc->vc_cols); count++) {
62762306a36Sopenharmony_ci			if (scr_readw(d) != vc->vc_video_erase_char) {
62862306a36Sopenharmony_ci				newport_putc(vc, vc->vc_video_erase_char,
62962306a36Sopenharmony_ci					     y, x);
63062306a36Sopenharmony_ci				scr_writew(vc->vc_video_erase_char, d);
63162306a36Sopenharmony_ci			}
63262306a36Sopenharmony_ci			d++;
63362306a36Sopenharmony_ci			if (++x == vc->vc_cols) {
63462306a36Sopenharmony_ci				x = 0;
63562306a36Sopenharmony_ci				y++;
63662306a36Sopenharmony_ci			}
63762306a36Sopenharmony_ci		}
63862306a36Sopenharmony_ci	} else {
63962306a36Sopenharmony_ci		x = vc->vc_cols - 1;
64062306a36Sopenharmony_ci		y = b - 1;
64162306a36Sopenharmony_ci		s = (unsigned short *) (vc->vc_origin +
64262306a36Sopenharmony_ci					vc->vc_size_row * (b - lines) - 2);
64362306a36Sopenharmony_ci		d = (unsigned short *) (vc->vc_origin +
64462306a36Sopenharmony_ci					vc->vc_size_row * b - 2);
64562306a36Sopenharmony_ci		while (count--) {
64662306a36Sopenharmony_ci			chattr = scr_readw(s--);
64762306a36Sopenharmony_ci			if (chattr != scr_readw(d)) {
64862306a36Sopenharmony_ci				newport_putc(vc, chattr, y, x);
64962306a36Sopenharmony_ci				scr_writew(chattr, d);
65062306a36Sopenharmony_ci			}
65162306a36Sopenharmony_ci			d--;
65262306a36Sopenharmony_ci			if (x-- == 0) {
65362306a36Sopenharmony_ci				x = vc->vc_cols - 1;
65462306a36Sopenharmony_ci				y--;
65562306a36Sopenharmony_ci			}
65662306a36Sopenharmony_ci		}
65762306a36Sopenharmony_ci		d = (unsigned short *) (vc->vc_origin +
65862306a36Sopenharmony_ci					vc->vc_size_row * t);
65962306a36Sopenharmony_ci		x = 0;
66062306a36Sopenharmony_ci		y = t;
66162306a36Sopenharmony_ci		for (count = 0; count < (lines * vc->vc_cols); count++) {
66262306a36Sopenharmony_ci			if (scr_readw(d) != vc->vc_video_erase_char) {
66362306a36Sopenharmony_ci				newport_putc(vc, vc->vc_video_erase_char,
66462306a36Sopenharmony_ci					     y, x);
66562306a36Sopenharmony_ci				scr_writew(vc->vc_video_erase_char, d);
66662306a36Sopenharmony_ci			}
66762306a36Sopenharmony_ci			d++;
66862306a36Sopenharmony_ci			if (++x == vc->vc_cols) {
66962306a36Sopenharmony_ci				x = 0;
67062306a36Sopenharmony_ci				y++;
67162306a36Sopenharmony_ci			}
67262306a36Sopenharmony_ci		}
67362306a36Sopenharmony_ci	}
67462306a36Sopenharmony_ci	return true;
67562306a36Sopenharmony_ci}
67662306a36Sopenharmony_ci
67762306a36Sopenharmony_cistatic void newport_save_screen(struct vc_data *vc) { }
67862306a36Sopenharmony_ci
67962306a36Sopenharmony_ciconst struct consw newport_con = {
68062306a36Sopenharmony_ci	.owner		  = THIS_MODULE,
68162306a36Sopenharmony_ci	.con_startup	  = newport_startup,
68262306a36Sopenharmony_ci	.con_init	  = newport_init,
68362306a36Sopenharmony_ci	.con_deinit	  = newport_deinit,
68462306a36Sopenharmony_ci	.con_clear	  = newport_clear,
68562306a36Sopenharmony_ci	.con_putc	  = newport_putc,
68662306a36Sopenharmony_ci	.con_putcs	  = newport_putcs,
68762306a36Sopenharmony_ci	.con_cursor	  = newport_cursor,
68862306a36Sopenharmony_ci	.con_scroll	  = newport_scroll,
68962306a36Sopenharmony_ci	.con_switch	  = newport_switch,
69062306a36Sopenharmony_ci	.con_blank	  = newport_blank,
69162306a36Sopenharmony_ci	.con_font_set	  = newport_font_set,
69262306a36Sopenharmony_ci	.con_font_default = newport_font_default,
69362306a36Sopenharmony_ci	.con_save_screen  = newport_save_screen
69462306a36Sopenharmony_ci};
69562306a36Sopenharmony_ci
69662306a36Sopenharmony_cistatic int newport_probe(struct gio_device *dev,
69762306a36Sopenharmony_ci			 const struct gio_device_id *id)
69862306a36Sopenharmony_ci{
69962306a36Sopenharmony_ci	int err;
70062306a36Sopenharmony_ci
70162306a36Sopenharmony_ci	if (!dev->resource.start)
70262306a36Sopenharmony_ci		return -EINVAL;
70362306a36Sopenharmony_ci
70462306a36Sopenharmony_ci	if (npregs)
70562306a36Sopenharmony_ci		return -EBUSY; /* we only support one Newport as console */
70662306a36Sopenharmony_ci
70762306a36Sopenharmony_ci	newport_addr = dev->resource.start + 0xF0000;
70862306a36Sopenharmony_ci	if (!request_mem_region(newport_addr, NEWPORT_LEN, "Newport"))
70962306a36Sopenharmony_ci		return -ENODEV;
71062306a36Sopenharmony_ci
71162306a36Sopenharmony_ci	npregs = (struct newport_regs *)/* ioremap cannot fail */
71262306a36Sopenharmony_ci		ioremap(newport_addr, sizeof(struct newport_regs));
71362306a36Sopenharmony_ci	console_lock();
71462306a36Sopenharmony_ci	err = do_take_over_console(&newport_con, 0, MAX_NR_CONSOLES - 1, 1);
71562306a36Sopenharmony_ci	console_unlock();
71662306a36Sopenharmony_ci
71762306a36Sopenharmony_ci	if (err) {
71862306a36Sopenharmony_ci		iounmap((void *)npregs);
71962306a36Sopenharmony_ci		release_mem_region(newport_addr, NEWPORT_LEN);
72062306a36Sopenharmony_ci	}
72162306a36Sopenharmony_ci	return err;
72262306a36Sopenharmony_ci}
72362306a36Sopenharmony_ci
72462306a36Sopenharmony_cistatic void newport_remove(struct gio_device *dev)
72562306a36Sopenharmony_ci{
72662306a36Sopenharmony_ci	give_up_console(&newport_con);
72762306a36Sopenharmony_ci	iounmap((void *)npregs);
72862306a36Sopenharmony_ci	release_mem_region(newport_addr, NEWPORT_LEN);
72962306a36Sopenharmony_ci}
73062306a36Sopenharmony_ci
73162306a36Sopenharmony_cistatic struct gio_device_id newport_ids[] = {
73262306a36Sopenharmony_ci	{ .id = 0x7e },
73362306a36Sopenharmony_ci	{ .id = 0xff }
73462306a36Sopenharmony_ci};
73562306a36Sopenharmony_ci
73662306a36Sopenharmony_ciMODULE_ALIAS("gio:7e");
73762306a36Sopenharmony_ci
73862306a36Sopenharmony_cistatic struct gio_driver newport_driver = {
73962306a36Sopenharmony_ci	.name = "newport",
74062306a36Sopenharmony_ci	.id_table = newport_ids,
74162306a36Sopenharmony_ci	.probe = newport_probe,
74262306a36Sopenharmony_ci	.remove = newport_remove,
74362306a36Sopenharmony_ci};
74462306a36Sopenharmony_cimodule_driver(newport_driver, gio_register_driver, gio_unregister_driver);
74562306a36Sopenharmony_ci
74662306a36Sopenharmony_ciMODULE_LICENSE("GPL");
747