pm.c revision 1.1.2.15 1 1.1.2.14 nisimura /* $NetBSD: pm.c,v 1.1.2.15 1999/11/19 11:06:25 nisimura Exp $ */
2 1.1.2.1 nisimura
3 1.1.2.4 nisimura /*
4 1.1.2.4 nisimura * Copyright (c) 1998 Tohru Nishimura. All rights reserved.
5 1.1.2.4 nisimura *
6 1.1.2.4 nisimura * Redistribution and use in source and binary forms, with or without
7 1.1.2.4 nisimura * modification, are permitted provided that the following conditions
8 1.1.2.4 nisimura * are met:
9 1.1.2.4 nisimura * 1. Redistributions of source code must retain the above copyright
10 1.1.2.4 nisimura * notice, this list of conditions and the following disclaimer.
11 1.1.2.4 nisimura * 2. Redistributions in binary form must reproduce the above copyright
12 1.1.2.4 nisimura * notice, this list of conditions and the following disclaimer in the
13 1.1.2.4 nisimura * documentation and/or other materials provided with the distribution.
14 1.1.2.4 nisimura * 3. All advertising materials mentioning features or use of this software
15 1.1.2.4 nisimura * must display the following acknowledgement:
16 1.1.2.4 nisimura * This product includes software developed by Tohru Nishimura
17 1.1.2.4 nisimura * for the NetBSD Project.
18 1.1.2.4 nisimura * 4. The name of the author may not be used to endorse or promote products
19 1.1.2.4 nisimura * derived from this software without specific prior written permission
20 1.1.2.4 nisimura *
21 1.1.2.4 nisimura * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.1.2.4 nisimura * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.1.2.4 nisimura * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.1.2.4 nisimura * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.1.2.4 nisimura * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.1.2.4 nisimura * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.1.2.4 nisimura * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.1.2.4 nisimura * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.1.2.4 nisimura * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 1.1.2.4 nisimura * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.1.2.4 nisimura */
32 1.1.2.4 nisimura
33 1.1.2.1 nisimura #include <sys/cdefs.h> /* RCS ID & Copyright macro defns */
34 1.1.2.1 nisimura
35 1.1.2.14 nisimura __KERNEL_RCSID(0, "$Id: pm.c,v 1.1.2.15 1999/11/19 11:06:25 nisimura Exp $");
36 1.1.2.1 nisimura
37 1.1.2.1 nisimura #include <sys/param.h>
38 1.1.2.1 nisimura #include <sys/systm.h>
39 1.1.2.1 nisimura #include <sys/device.h>
40 1.1.2.15 nisimura #include <sys/kernel.h>
41 1.1.2.1 nisimura #include <sys/malloc.h>
42 1.1.2.1 nisimura #include <sys/buf.h>
43 1.1.2.1 nisimura #include <sys/ioctl.h>
44 1.1.2.1 nisimura #include <vm/vm.h>
45 1.1.2.9 nisimura #include <uvm/uvm_extern.h>
46 1.1.2.1 nisimura
47 1.1.2.1 nisimura #include <dev/rcons/raster.h>
48 1.1.2.1 nisimura #include <dev/wscons/wsconsio.h>
49 1.1.2.1 nisimura #include <dev/wscons/wscons_raster.h>
50 1.1.2.1 nisimura #include <dev/wscons/wsdisplayvar.h>
51 1.1.2.1 nisimura
52 1.1.2.9 nisimura #include <machine/cpu.h>
53 1.1.2.15 nisimura #include <machine/bus.h>
54 1.1.2.1 nisimura #include <pmax/ibus/ibusvar.h>
55 1.1.2.1 nisimura
56 1.1.2.2 nisimura extern void kn01_wbflush __P((void));
57 1.1.2.2 nisimura
58 1.1.2.1 nisimura struct pccreg {
59 1.1.2.10 nisimura #define _HALF_(xxx) u_int16_t xxx; unsigned : 16
60 1.1.2.10 nisimura _HALF_(pcc_cmdr); /* cursor command register */
61 1.1.2.10 nisimura _HALF_(pcc_xpos); /* cursor X position */
62 1.1.2.10 nisimura _HALF_(pcc_ypos); /* cursor Y position */
63 1.1.2.10 nisimura _HALF_(pcc_xmin1); /* region 1 top edge */
64 1.1.2.10 nisimura _HALF_(pcc_xmax1); /* region 1 bottom edge */
65 1.1.2.10 nisimura _HALF_(pcc_ymin1); /* region 1 top edge */
66 1.1.2.10 nisimura _HALF_(pcc_ymax1); /* region 1 bottom edge */
67 1.1.2.1 nisimura unsigned : 32; /* unused */
68 1.1.2.1 nisimura unsigned : 32; /* unused */
69 1.1.2.1 nisimura unsigned : 32; /* unused */
70 1.1.2.1 nisimura unsigned : 32; /* unused */
71 1.1.2.10 nisimura _HALF_(pcc_xmin2); /* region 2 top edge */
72 1.1.2.10 nisimura _HALF_(pcc_xmax2); /* region 2 bottom edge */
73 1.1.2.10 nisimura _HALF_(pcc_ymin2); /* region 2 top edge */
74 1.1.2.10 nisimura _HALF_(pcc_ymax2); /* region 2 bottom edge */
75 1.1.2.10 nisimura _HALF_(pcc_memory); /* cursor sprite pattern load */
76 1.1.2.10 nisimura #undef _HALF_
77 1.1.2.1 nisimura };
78 1.1.2.1 nisimura
79 1.1.2.1 nisimura #define PCC_ENPA 0000001
80 1.1.2.1 nisimura #define PCC_FOPA 0000002
81 1.1.2.1 nisimura #define PCC_ENPB 0000004
82 1.1.2.1 nisimura #define PCC_FOPB 0000010
83 1.1.2.1 nisimura #define PCC_XHAIR 0000020
84 1.1.2.1 nisimura #define PCC_XHCLP 0000040
85 1.1.2.1 nisimura #define PCC_XHCL1 0000100
86 1.1.2.1 nisimura #define PCC_XHWID 0000200
87 1.1.2.1 nisimura #define PCC_ENRG1 0000400
88 1.1.2.1 nisimura #define PCC_FORG1 0001000
89 1.1.2.1 nisimura #define PCC_ENRG2 0002000
90 1.1.2.1 nisimura #define PCC_FORG2 0004000
91 1.1.2.1 nisimura #define PCC_LODSA 0010000
92 1.1.2.1 nisimura #define PCC_VBHI 0020000
93 1.1.2.1 nisimura #define PCC_HSHI 0040000
94 1.1.2.1 nisimura #define PCC_TEST 0100000
95 1.1.2.1 nisimura
96 1.1.2.3 nisimura struct bt478reg {
97 1.1.2.10 nisimura #define _BYTE_(yyy) u_int8_t yyy; unsigned : 24
98 1.1.2.3 nisimura _BYTE_(bt_mapWA); /* address register (color map write) */
99 1.1.2.3 nisimura _BYTE_(bt_map); /* color map */
100 1.1.2.3 nisimura _BYTE_(bt_mask); /* pixel read mask */
101 1.1.2.3 nisimura _BYTE_(bt_mapRA); /* address register (color map read) */
102 1.1.2.3 nisimura _BYTE_(bt_overWA); /* address register (overlay map write) */
103 1.1.2.3 nisimura _BYTE_(bt_over); /* overlay map */
104 1.1.2.3 nisimura unsigned : 32; /* unused */
105 1.1.2.3 nisimura _BYTE_(bt_overRA); /* address register (overlay map read) */
106 1.1.2.3 nisimura #undef _BYTE_
107 1.1.2.3 nisimura };
108 1.1.2.3 nisimura
109 1.1.2.1 nisimura struct fb_devconfig {
110 1.1.2.1 nisimura vaddr_t dc_vaddr; /* memory space virtual base address */
111 1.1.2.1 nisimura paddr_t dc_paddr; /* memory space physical base address */
112 1.1.2.1 nisimura vsize_t dc_size; /* size of slot memory */
113 1.1.2.1 nisimura int dc_wid; /* width of frame buffer */
114 1.1.2.1 nisimura int dc_ht; /* height of frame buffer */
115 1.1.2.1 nisimura int dc_depth; /* depth, bits per pixel */
116 1.1.2.1 nisimura int dc_rowbytes; /* bytes in a FB scan line */
117 1.1.2.1 nisimura vaddr_t dc_videobase; /* base of flat frame buffer */
118 1.1.2.1 nisimura struct raster dc_raster; /* raster description */
119 1.1.2.1 nisimura struct rcons dc_rcons; /* raster blitter control info */
120 1.1.2.1 nisimura int dc_blanked; /* currently has video disabled */
121 1.1.2.1 nisimura };
122 1.1.2.1 nisimura
123 1.1.2.15 nisimura struct hwcmap256 {
124 1.1.2.1 nisimura #define CMAP_SIZE 256 /* 256 R/G/B entries */
125 1.1.2.1 nisimura u_int8_t r[CMAP_SIZE];
126 1.1.2.1 nisimura u_int8_t g[CMAP_SIZE];
127 1.1.2.1 nisimura u_int8_t b[CMAP_SIZE];
128 1.1.2.1 nisimura };
129 1.1.2.1 nisimura
130 1.1.2.15 nisimura struct hwcursor16 {
131 1.1.2.1 nisimura struct wsdisplay_curpos cc_pos;
132 1.1.2.1 nisimura struct wsdisplay_curpos cc_hot;
133 1.1.2.1 nisimura struct wsdisplay_curpos cc_size;
134 1.1.2.1 nisimura #define CURSOR_MAX_SIZE 16
135 1.1.2.1 nisimura u_int8_t cc_color[6];
136 1.1.2.7 nisimura u_int32_t cc_image[16 + 16];
137 1.1.2.1 nisimura };
138 1.1.2.1 nisimura
139 1.1.2.1 nisimura struct pm_softc {
140 1.1.2.1 nisimura struct device sc_dev;
141 1.1.2.1 nisimura struct fb_devconfig *sc_dc; /* device configuration */
142 1.1.2.15 nisimura struct hwcmap256 sc_cmap; /* software copy of colormap */
143 1.1.2.15 nisimura struct hwcursor16 sc_cursor; /* software copy of cursor */
144 1.1.2.1 nisimura /* no sc_change field because pm does not emit interrupt */
145 1.1.2.1 nisimura int nscreens;
146 1.1.2.4 nisimura short magic_x, magic_y; /* cursor location offset */
147 1.1.2.1 nisimura
148 1.1.2.1 nisimura struct pccreg *sc_pcc;
149 1.1.2.1 nisimura struct bt478reg *sc_vdac;
150 1.1.2.1 nisimura u_int16_t sc_pcccmdr; /* software copy of PCC cmdr */
151 1.1.2.1 nisimura };
152 1.1.2.1 nisimura
153 1.1.2.15 nisimura #define PCC_MAGIC_X 212
154 1.1.2.15 nisimura #define PCC_MAGIC_Y 34
155 1.1.2.15 nisimura
156 1.1.2.15 nisimura static int pmmatch __P((struct device *, struct cfdata *, void *));
157 1.1.2.15 nisimura static void pmattach __P((struct device *, struct device *, void *));
158 1.1.2.1 nisimura
159 1.1.2.15 nisimura const struct cfattach pm_ca = {
160 1.1.2.1 nisimura sizeof(struct pm_softc), pmmatch, pmattach,
161 1.1.2.1 nisimura };
162 1.1.2.1 nisimura
163 1.1.2.15 nisimura static u_int32_t pm_consaddr;
164 1.1.2.15 nisimura static struct fb_devconfig pm_console_dc;
165 1.1.2.15 nisimura static void pm_getdevconfig __P((u_int32_t, struct fb_devconfig *));
166 1.1.2.15 nisimura static void pminit __P((struct fb_devconfig *));
167 1.1.2.1 nisimura
168 1.1.2.15 nisimura int pm_cnattach __P((paddr_t));
169 1.1.2.15 nisimura
170 1.1.2.15 nisimura static const struct wsdisplay_emulops pm_emulops = {
171 1.1.2.1 nisimura rcons_cursor,
172 1.1.2.1 nisimura rcons_mapchar,
173 1.1.2.1 nisimura rcons_putchar,
174 1.1.2.1 nisimura rcons_copycols,
175 1.1.2.1 nisimura rcons_erasecols,
176 1.1.2.1 nisimura rcons_copyrows,
177 1.1.2.1 nisimura rcons_eraserows,
178 1.1.2.1 nisimura rcons_alloc_attr
179 1.1.2.1 nisimura };
180 1.1.2.1 nisimura
181 1.1.2.15 nisimura static struct wsscreen_descr pm_stdscreen = {
182 1.1.2.1 nisimura "std",
183 1.1.2.1 nisimura 0, 0, /* will be filled in -- XXX shouldn't, it's global */
184 1.1.2.1 nisimura &pm_emulops,
185 1.1.2.1 nisimura 0, 0,
186 1.1.2.14 nisimura WSSCREEN_REVERSE
187 1.1.2.1 nisimura };
188 1.1.2.1 nisimura
189 1.1.2.15 nisimura static const struct wsscreen_descr *_pm_scrlist[] = {
190 1.1.2.1 nisimura &pm_stdscreen,
191 1.1.2.1 nisimura };
192 1.1.2.1 nisimura
193 1.1.2.15 nisimura static const struct wsscreen_list pm_screenlist = {
194 1.1.2.1 nisimura sizeof(_pm_scrlist) / sizeof(struct wsscreen_descr *), _pm_scrlist
195 1.1.2.1 nisimura };
196 1.1.2.1 nisimura
197 1.1.2.15 nisimura static int pmioctl __P((void *, u_long, caddr_t, int, struct proc *));
198 1.1.2.15 nisimura static int pmmmap __P((void *, off_t, int));
199 1.1.2.1 nisimura
200 1.1.2.15 nisimura static int pm_alloc_screen __P((void *, const struct wsscreen_descr *,
201 1.1.2.1 nisimura void **, int *, int *, long *));
202 1.1.2.15 nisimura static void pm_free_screen __P((void *, void *));
203 1.1.2.15 nisimura static void pm_show_screen __P((void *, void *));
204 1.1.2.1 nisimura
205 1.1.2.15 nisimura static const struct wsdisplay_accessops pm_accessops = {
206 1.1.2.1 nisimura pmioctl,
207 1.1.2.1 nisimura pmmmap,
208 1.1.2.1 nisimura pm_alloc_screen,
209 1.1.2.1 nisimura pm_free_screen,
210 1.1.2.1 nisimura pm_show_screen,
211 1.1.2.6 drochner 0 /* load_font */
212 1.1.2.1 nisimura };
213 1.1.2.1 nisimura
214 1.1.2.1 nisimura
215 1.1.2.1 nisimura static int set_cmap __P((struct pm_softc *, struct wsdisplay_cmap *));
216 1.1.2.1 nisimura static int get_cmap __P((struct pm_softc *, struct wsdisplay_cmap *));
217 1.1.2.1 nisimura static int set_cursor __P((struct pm_softc *, struct wsdisplay_cursor *));
218 1.1.2.1 nisimura static int get_cursor __P((struct pm_softc *, struct wsdisplay_cursor *));
219 1.1.2.1 nisimura static void set_curpos __P((struct pm_softc *, struct wsdisplay_curpos *));
220 1.1.2.15 nisimura static void bt478_loadcmap __P((struct pm_softc *));
221 1.1.2.15 nisimura static void bt478_load_curcmap __P((struct pm_softc *));
222 1.1.2.15 nisimura static void pcc_load_curshape __P((struct pm_softc *));
223 1.1.2.15 nisimura static void pcc_set_curpos __P((struct pm_softc *));
224 1.1.2.15 nisimura static void pcc_show_cursor __P((struct pm_softc *, int));
225 1.1.2.1 nisimura
226 1.1.2.1 nisimura #define KN01_SYS_PCC 0x11100000
227 1.1.2.1 nisimura #define KN01_SYS_BT478 0x11200000
228 1.1.2.1 nisimura #define KN01_SYS_PMASK 0x10000000
229 1.1.2.3 nisimura #define KN01_SYS_CSR 0x1e000000
230 1.1.2.3 nisimura #define KN01_CSR_MONO 0x0800
231 1.1.2.1 nisimura
232 1.1.2.15 nisimura
233 1.1.2.15 nisimura static int
234 1.1.2.1 nisimura pmmatch(parent, match, aux)
235 1.1.2.1 nisimura struct device *parent;
236 1.1.2.1 nisimura struct cfdata *match;
237 1.1.2.1 nisimura void *aux;
238 1.1.2.1 nisimura {
239 1.1.2.1 nisimura struct ibus_attach_args *ia = aux;
240 1.1.2.1 nisimura
241 1.1.2.1 nisimura if (strcmp("pm", ia->ia_name))
242 1.1.2.1 nisimura return (0);
243 1.1.2.1 nisimura if (badaddr((char *)ia->ia_addr, 4))
244 1.1.2.1 nisimura return (0);
245 1.1.2.1 nisimura return (1);
246 1.1.2.1 nisimura }
247 1.1.2.1 nisimura
248 1.1.2.15 nisimura static void
249 1.1.2.1 nisimura pm_getdevconfig(dense_addr, dc)
250 1.1.2.8 nisimura u_int32_t dense_addr;
251 1.1.2.1 nisimura struct fb_devconfig *dc;
252 1.1.2.1 nisimura {
253 1.1.2.1 nisimura struct raster *rap;
254 1.1.2.1 nisimura struct rcons *rcp;
255 1.1.2.3 nisimura u_int16_t *p = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_CSR);
256 1.1.2.1 nisimura int i;
257 1.1.2.1 nisimura
258 1.1.2.1 nisimura dc->dc_wid = 1024;
259 1.1.2.1 nisimura dc->dc_ht = 864;
260 1.1.2.3 nisimura dc->dc_depth = (*p & KN01_CSR_MONO) ? 1 : 8;
261 1.1.2.3 nisimura dc->dc_rowbytes = (dc->dc_depth == 8) ? 1024 : 1024 / 8;
262 1.1.2.3 nisimura dc->dc_videobase = dense_addr;
263 1.1.2.1 nisimura dc->dc_blanked = 0;
264 1.1.2.1 nisimura
265 1.1.2.3 nisimura dc->dc_vaddr = dense_addr;
266 1.1.2.3 nisimura dc->dc_paddr = MIPS_KSEG1_TO_PHYS(dc->dc_vaddr);
267 1.1.2.3 nisimura dc->dc_size = (dc->dc_depth == 8) ? 0x100000 : 0x40000;
268 1.1.2.3 nisimura
269 1.1.2.1 nisimura /* initialize colormap and cursor resource */
270 1.1.2.1 nisimura pminit(dc);
271 1.1.2.1 nisimura
272 1.1.2.1 nisimura /* clear the screen */
273 1.1.2.1 nisimura for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
274 1.1.2.1 nisimura *(u_int32_t *)(dc->dc_videobase + i) = 0;
275 1.1.2.1 nisimura
276 1.1.2.1 nisimura /* initialize the raster */
277 1.1.2.1 nisimura rap = &dc->dc_raster;
278 1.1.2.1 nisimura rap->width = dc->dc_wid;
279 1.1.2.1 nisimura rap->height = dc->dc_ht;
280 1.1.2.1 nisimura rap->depth = dc->dc_depth;
281 1.1.2.1 nisimura rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
282 1.1.2.1 nisimura rap->pixels = (u_int32_t *)dc->dc_videobase;
283 1.1.2.1 nisimura
284 1.1.2.1 nisimura /* initialize the raster console blitter */
285 1.1.2.1 nisimura rcp = &dc->dc_rcons;
286 1.1.2.1 nisimura rcp->rc_sp = rap;
287 1.1.2.1 nisimura rcp->rc_crow = rcp->rc_ccol = -1;
288 1.1.2.1 nisimura rcp->rc_crowp = &rcp->rc_crow;
289 1.1.2.1 nisimura rcp->rc_ccolp = &rcp->rc_ccol;
290 1.1.2.1 nisimura rcons_init(rcp, 34, 80);
291 1.1.2.1 nisimura
292 1.1.2.1 nisimura pm_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
293 1.1.2.1 nisimura pm_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
294 1.1.2.1 nisimura }
295 1.1.2.1 nisimura
296 1.1.2.15 nisimura static void
297 1.1.2.1 nisimura pmattach(parent, self, aux)
298 1.1.2.1 nisimura struct device *parent, *self;
299 1.1.2.1 nisimura void *aux;
300 1.1.2.1 nisimura {
301 1.1.2.1 nisimura struct pm_softc *sc = (struct pm_softc *)self;
302 1.1.2.1 nisimura struct ibus_attach_args *ia = aux;
303 1.1.2.1 nisimura struct wsemuldisplaydev_attach_args waa;
304 1.1.2.15 nisimura struct hwcmap256 *cm;
305 1.1.2.1 nisimura int console, i;
306 1.1.2.1 nisimura
307 1.1.2.15 nisimura console = (ia->ia_addr == pm_consaddr);
308 1.1.2.1 nisimura if (console) {
309 1.1.2.1 nisimura sc->sc_dc = &pm_console_dc;
310 1.1.2.1 nisimura sc->nscreens = 1;
311 1.1.2.1 nisimura }
312 1.1.2.1 nisimura else {
313 1.1.2.1 nisimura sc->sc_dc = (struct fb_devconfig *)
314 1.1.2.1 nisimura malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
315 1.1.2.1 nisimura pm_getdevconfig(ia->ia_addr, sc->sc_dc);
316 1.1.2.1 nisimura }
317 1.1.2.1 nisimura printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
318 1.1.2.1 nisimura sc->sc_dc->dc_depth);
319 1.1.2.1 nisimura
320 1.1.2.1 nisimura cm = &sc->sc_cmap;
321 1.1.2.1 nisimura cm->r[0] = cm->g[0] = cm->b[0] = 0;
322 1.1.2.1 nisimura for (i = 1; i < CMAP_SIZE; i++) {
323 1.1.2.1 nisimura cm->r[i] = cm->g[i] = cm->b[i] = 0xff;
324 1.1.2.1 nisimura }
325 1.1.2.4 nisimura sc->magic_x = PCC_MAGIC_X;
326 1.1.2.4 nisimura sc->magic_y = PCC_MAGIC_Y;
327 1.1.2.1 nisimura sc->sc_pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
328 1.1.2.1 nisimura sc->sc_vdac = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_BT478);
329 1.1.2.1 nisimura sc->sc_pcccmdr = 0;
330 1.1.2.1 nisimura
331 1.1.2.1 nisimura /* pm emits no interrupt */
332 1.1.2.1 nisimura
333 1.1.2.1 nisimura waa.console = console;
334 1.1.2.1 nisimura waa.scrdata = &pm_screenlist;
335 1.1.2.1 nisimura waa.accessops = &pm_accessops;
336 1.1.2.1 nisimura waa.accesscookie = sc;
337 1.1.2.1 nisimura
338 1.1.2.1 nisimura config_found(self, &waa, wsemuldisplaydevprint);
339 1.1.2.1 nisimura }
340 1.1.2.1 nisimura
341 1.1.2.1 nisimura int
342 1.1.2.15 nisimura pm_cnattach(addr)
343 1.1.2.15 nisimura paddr_t addr;
344 1.1.2.15 nisimura {
345 1.1.2.15 nisimura u_int32_t v = MIPS_PHYS_TO_KSEG1(addr);
346 1.1.2.15 nisimura struct fb_devconfig *dcp = &pm_console_dc;
347 1.1.2.15 nisimura long defattr;
348 1.1.2.15 nisimura
349 1.1.2.15 nisimura if (badaddr((char *)v, 4))
350 1.1.2.15 nisimura return (0);
351 1.1.2.15 nisimura
352 1.1.2.15 nisimura pm_getdevconfig(v, dcp);
353 1.1.2.15 nisimura rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);
354 1.1.2.15 nisimura wsdisplay_cnattach(&pm_stdscreen, &dcp->dc_rcons,
355 1.1.2.15 nisimura 0, 0, defattr);
356 1.1.2.15 nisimura
357 1.1.2.15 nisimura pm_consaddr = v;
358 1.1.2.15 nisimura return (1);
359 1.1.2.15 nisimura }
360 1.1.2.15 nisimura
361 1.1.2.15 nisimura static int
362 1.1.2.1 nisimura pmioctl(v, cmd, data, flag, p)
363 1.1.2.1 nisimura void *v;
364 1.1.2.1 nisimura u_long cmd;
365 1.1.2.1 nisimura caddr_t data;
366 1.1.2.1 nisimura int flag;
367 1.1.2.1 nisimura struct proc *p;
368 1.1.2.1 nisimura {
369 1.1.2.1 nisimura struct pm_softc *sc = v;
370 1.1.2.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
371 1.1.2.4 nisimura int turnoff, error;
372 1.1.2.1 nisimura
373 1.1.2.1 nisimura switch (cmd) {
374 1.1.2.1 nisimura case WSDISPLAYIO_GTYPE:
375 1.1.2.3 nisimura *(u_int *)data = (dc->dc_depth == 8)
376 1.1.2.3 nisimura ? WSDISPLAY_TYPE_PM_COLOR : WSDISPLAY_TYPE_PM_MONO;
377 1.1.2.1 nisimura return (0);
378 1.1.2.1 nisimura
379 1.1.2.1 nisimura case WSDISPLAYIO_GINFO:
380 1.1.2.1 nisimura #define wsd_fbip ((struct wsdisplay_fbinfo *)data)
381 1.1.2.1 nisimura wsd_fbip->height = sc->sc_dc->dc_ht;
382 1.1.2.1 nisimura wsd_fbip->width = sc->sc_dc->dc_wid;
383 1.1.2.1 nisimura wsd_fbip->depth = sc->sc_dc->dc_depth;
384 1.1.2.1 nisimura wsd_fbip->cmsize = CMAP_SIZE;
385 1.1.2.1 nisimura #undef fbt
386 1.1.2.1 nisimura return (0);
387 1.1.2.1 nisimura
388 1.1.2.1 nisimura case WSDISPLAYIO_GETCMAP:
389 1.1.2.1 nisimura return get_cmap(sc, (struct wsdisplay_cmap *)data);
390 1.1.2.1 nisimura
391 1.1.2.1 nisimura case WSDISPLAYIO_PUTCMAP:
392 1.1.2.1 nisimura error = set_cmap(sc, (struct wsdisplay_cmap *)data);
393 1.1.2.1 nisimura if (error == 0)
394 1.1.2.1 nisimura bt478_loadcmap(sc);
395 1.1.2.1 nisimura return (error);
396 1.1.2.1 nisimura
397 1.1.2.1 nisimura case WSDISPLAYIO_SVIDEO:
398 1.1.2.4 nisimura turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
399 1.1.2.4 nisimura if ((dc->dc_blanked == 0) ^ turnoff) {
400 1.1.2.4 nisimura dc->dc_blanked = turnoff;
401 1.1.2.13 nisimura #if 0 /* XXX later XXX */
402 1.1.2.13 nisimura DS3100 Functional Specification Revision 1.3 says;
403 1.1.2.13 nisimura be blanked by using the cursor plane control bits to force the output
404 1.1.2.13 nisimura of both planes and changing VDAC overlay map entry 12 to 0x000000.
405 1.1.2.13 nisimura #endif
406 1.1.2.4 nisimura }
407 1.1.2.1 nisimura return (0);
408 1.1.2.1 nisimura
409 1.1.2.1 nisimura case WSDISPLAYIO_GVIDEO:
410 1.1.2.1 nisimura *(u_int *)data = dc->dc_blanked ?
411 1.1.2.1 nisimura WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
412 1.1.2.1 nisimura return (0);
413 1.1.2.1 nisimura
414 1.1.2.1 nisimura case WSDISPLAYIO_GCURPOS:
415 1.1.2.1 nisimura *(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
416 1.1.2.1 nisimura return (0);
417 1.1.2.1 nisimura
418 1.1.2.1 nisimura case WSDISPLAYIO_SCURPOS:
419 1.1.2.1 nisimura set_curpos(sc, (struct wsdisplay_curpos *)data);
420 1.1.2.1 nisimura pcc_set_curpos(sc);
421 1.1.2.1 nisimura return (0);
422 1.1.2.1 nisimura
423 1.1.2.1 nisimura case WSDISPLAYIO_GCURMAX:
424 1.1.2.1 nisimura ((struct wsdisplay_curpos *)data)->x =
425 1.1.2.1 nisimura ((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
426 1.1.2.1 nisimura return (0);
427 1.1.2.1 nisimura
428 1.1.2.1 nisimura case WSDISPLAYIO_GCURSOR:
429 1.1.2.1 nisimura return get_cursor(sc, (struct wsdisplay_cursor *)data);
430 1.1.2.1 nisimura
431 1.1.2.1 nisimura case WSDISPLAYIO_SCURSOR:
432 1.1.2.1 nisimura return set_cursor(sc, (struct wsdisplay_cursor *)data);
433 1.1.2.1 nisimura }
434 1.1.2.15 nisimura return -1;
435 1.1.2.1 nisimura }
436 1.1.2.1 nisimura
437 1.1.2.15 nisimura static int
438 1.1.2.1 nisimura pmmmap(v, offset, prot)
439 1.1.2.1 nisimura void *v;
440 1.1.2.1 nisimura off_t offset;
441 1.1.2.1 nisimura int prot;
442 1.1.2.1 nisimura {
443 1.1.2.1 nisimura struct pm_softc *sc = v;
444 1.1.2.1 nisimura
445 1.1.2.5 nisimura if (offset >= sc->sc_dc->dc_size)
446 1.1.2.1 nisimura return -1;
447 1.1.2.1 nisimura return mips_btop(sc->sc_dc->dc_paddr + offset);
448 1.1.2.1 nisimura }
449 1.1.2.1 nisimura
450 1.1.2.15 nisimura static int
451 1.1.2.1 nisimura pm_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
452 1.1.2.1 nisimura void *v;
453 1.1.2.1 nisimura const struct wsscreen_descr *type;
454 1.1.2.1 nisimura void **cookiep;
455 1.1.2.1 nisimura int *curxp, *curyp;
456 1.1.2.1 nisimura long *attrp;
457 1.1.2.1 nisimura {
458 1.1.2.1 nisimura struct pm_softc *sc = v;
459 1.1.2.1 nisimura long defattr;
460 1.1.2.1 nisimura
461 1.1.2.1 nisimura if (sc->nscreens > 0)
462 1.1.2.1 nisimura return (ENOMEM);
463 1.1.2.1 nisimura
464 1.1.2.1 nisimura *cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
465 1.1.2.1 nisimura *curxp = 0;
466 1.1.2.1 nisimura *curyp = 0;
467 1.1.2.1 nisimura rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
468 1.1.2.1 nisimura *attrp = defattr;
469 1.1.2.1 nisimura sc->nscreens++;
470 1.1.2.1 nisimura return (0);
471 1.1.2.1 nisimura }
472 1.1.2.1 nisimura
473 1.1.2.15 nisimura static void
474 1.1.2.1 nisimura pm_free_screen(v, cookie)
475 1.1.2.1 nisimura void *v;
476 1.1.2.1 nisimura void *cookie;
477 1.1.2.1 nisimura {
478 1.1.2.1 nisimura struct pm_softc *sc = v;
479 1.1.2.1 nisimura
480 1.1.2.1 nisimura if (sc->sc_dc == &pm_console_dc)
481 1.1.2.1 nisimura panic("pm_free_screen: console");
482 1.1.2.1 nisimura
483 1.1.2.1 nisimura sc->nscreens--;
484 1.1.2.1 nisimura }
485 1.1.2.1 nisimura
486 1.1.2.15 nisimura static void
487 1.1.2.1 nisimura pm_show_screen(v, cookie)
488 1.1.2.1 nisimura void *v;
489 1.1.2.1 nisimura void *cookie;
490 1.1.2.1 nisimura {
491 1.1.2.1 nisimura }
492 1.1.2.1 nisimura
493 1.1.2.15 nisimura static void
494 1.1.2.1 nisimura pminit(dc)
495 1.1.2.1 nisimura struct fb_devconfig *dc;
496 1.1.2.1 nisimura {
497 1.1.2.13 nisimura int i, n;
498 1.1.2.13 nisimura u_int16_t *p = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_CSR);
499 1.1.2.13 nisimura struct bt478reg *vdac = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_BT478);
500 1.1.2.13 nisimura struct pccreg *pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
501 1.1.2.13 nisimura
502 1.1.2.13 nisimura *(u_int8_t *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PMASK) = 0xff;
503 1.1.2.1 nisimura pcc->pcc_cmdr = PCC_FOPB | PCC_VBHI;
504 1.1.2.1 nisimura
505 1.1.2.13 nisimura i = 0;
506 1.1.2.13 nisimura n = (*p & KN01_CSR_MONO) ? 128 : 1;
507 1.1.2.13 nisimura vdac->bt_mapWA = 0; kn01_wbflush();
508 1.1.2.13 nisimura do {
509 1.1.2.13 nisimura vdac->bt_map = 0; kn01_wbflush();
510 1.1.2.13 nisimura vdac->bt_map = 0; kn01_wbflush();
511 1.1.2.13 nisimura vdac->bt_map = 0; kn01_wbflush();
512 1.1.2.13 nisimura } while (++i < n);
513 1.1.2.13 nisimura do {
514 1.1.2.2 nisimura vdac->bt_map = 0xff; kn01_wbflush();
515 1.1.2.2 nisimura vdac->bt_map = 0xff; kn01_wbflush();
516 1.1.2.2 nisimura vdac->bt_map = 0xff; kn01_wbflush();
517 1.1.2.13 nisimura } while (++i < CMAP_SIZE);
518 1.1.2.1 nisimura }
519 1.1.2.1 nisimura
520 1.1.2.1 nisimura static int
521 1.1.2.1 nisimura get_cmap(sc, p)
522 1.1.2.1 nisimura struct pm_softc *sc;
523 1.1.2.1 nisimura struct wsdisplay_cmap *p;
524 1.1.2.1 nisimura {
525 1.1.2.1 nisimura u_int index = p->index, count = p->count;
526 1.1.2.1 nisimura
527 1.1.2.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
528 1.1.2.1 nisimura return (EINVAL);
529 1.1.2.1 nisimura
530 1.1.2.9 nisimura if (!uvm_useracc(p->red, count, B_WRITE) ||
531 1.1.2.9 nisimura !uvm_useracc(p->green, count, B_WRITE) ||
532 1.1.2.9 nisimura !uvm_useracc(p->blue, count, B_WRITE))
533 1.1.2.1 nisimura return (EFAULT);
534 1.1.2.1 nisimura
535 1.1.2.1 nisimura copyout(&sc->sc_cmap.r[index], p->red, count);
536 1.1.2.1 nisimura copyout(&sc->sc_cmap.r[index], p->green, count);
537 1.1.2.1 nisimura copyout(&sc->sc_cmap.r[index], p->blue, count);
538 1.1.2.1 nisimura
539 1.1.2.1 nisimura return (0);
540 1.1.2.1 nisimura }
541 1.1.2.1 nisimura
542 1.1.2.1 nisimura static int
543 1.1.2.1 nisimura set_cmap(sc, p)
544 1.1.2.1 nisimura struct pm_softc *sc;
545 1.1.2.1 nisimura struct wsdisplay_cmap *p;
546 1.1.2.1 nisimura {
547 1.1.2.1 nisimura u_int index = p->index, count = p->count;
548 1.1.2.1 nisimura
549 1.1.2.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
550 1.1.2.1 nisimura return (EINVAL);
551 1.1.2.1 nisimura
552 1.1.2.9 nisimura if (!uvm_useracc(p->red, count, B_READ) ||
553 1.1.2.9 nisimura !uvm_useracc(p->green, count, B_READ) ||
554 1.1.2.9 nisimura !uvm_useracc(p->blue, count, B_READ))
555 1.1.2.1 nisimura return (EFAULT);
556 1.1.2.1 nisimura
557 1.1.2.1 nisimura copyin(p->red, &sc->sc_cmap.r[index], count);
558 1.1.2.1 nisimura copyin(p->green, &sc->sc_cmap.g[index], count);
559 1.1.2.1 nisimura copyin(p->blue, &sc->sc_cmap.b[index], count);
560 1.1.2.1 nisimura
561 1.1.2.1 nisimura return (0);
562 1.1.2.1 nisimura }
563 1.1.2.1 nisimura
564 1.1.2.1 nisimura static int
565 1.1.2.1 nisimura set_cursor(sc, p)
566 1.1.2.1 nisimura struct pm_softc *sc;
567 1.1.2.1 nisimura struct wsdisplay_cursor *p;
568 1.1.2.1 nisimura {
569 1.1.2.1 nisimura #define cc (&sc->sc_cursor)
570 1.1.2.1 nisimura int v, index, count;
571 1.1.2.1 nisimura
572 1.1.2.1 nisimura v = p->which;
573 1.1.2.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
574 1.1.2.1 nisimura index = p->cmap.index;
575 1.1.2.1 nisimura count = p->cmap.count;
576 1.1.2.1 nisimura if (index >= 2 || (index + count) > 2)
577 1.1.2.1 nisimura return (EINVAL);
578 1.1.2.9 nisimura if (!uvm_useracc(p->cmap.red, count, B_READ) ||
579 1.1.2.9 nisimura !uvm_useracc(p->cmap.green, count, B_READ) ||
580 1.1.2.9 nisimura !uvm_useracc(p->cmap.blue, count, B_READ))
581 1.1.2.1 nisimura return (EFAULT);
582 1.1.2.1 nisimura
583 1.1.2.1 nisimura count = p->cmap.count;
584 1.1.2.1 nisimura copyin(p->cmap.red, &cc->cc_color[index], count);
585 1.1.2.1 nisimura copyin(p->cmap.green, &cc->cc_color[index + 2], count);
586 1.1.2.1 nisimura copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
587 1.1.2.1 nisimura
588 1.1.2.1 nisimura bt478_load_curcmap(sc);
589 1.1.2.1 nisimura }
590 1.1.2.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
591 1.1.2.1 nisimura if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
592 1.1.2.1 nisimura return (EINVAL);
593 1.1.2.1 nisimura count = (CURSOR_MAX_SIZE / NBBY) * p->size.y;
594 1.1.2.9 nisimura if (!uvm_useracc(p->image, count, B_READ) ||
595 1.1.2.9 nisimura !uvm_useracc(p->mask, count, B_READ))
596 1.1.2.1 nisimura return (EFAULT);
597 1.1.2.1 nisimura cc->cc_size = p->size;
598 1.1.2.1 nisimura memset(cc->cc_image, 0, sizeof cc->cc_image);
599 1.1.2.1 nisimura copyin(p->image, (caddr_t)cc->cc_image, count);
600 1.1.2.1 nisimura copyin(p->mask, (caddr_t)(cc->cc_image+CURSOR_MAX_SIZE), count);
601 1.1.2.1 nisimura
602 1.1.2.1 nisimura pcc_load_curshape(sc);
603 1.1.2.1 nisimura }
604 1.1.2.1 nisimura if (v & WSDISPLAY_CURSOR_DOCUR) {
605 1.1.2.1 nisimura cc->cc_hot = p->hot;
606 1.1.2.1 nisimura pcc_show_cursor(sc, p->enable);
607 1.1.2.1 nisimura }
608 1.1.2.1 nisimura if (v & WSDISPLAY_CURSOR_DOPOS) {
609 1.1.2.1 nisimura set_curpos(sc, &p->pos);
610 1.1.2.1 nisimura pcc_set_curpos(sc);
611 1.1.2.1 nisimura }
612 1.1.2.1 nisimura
613 1.1.2.1 nisimura return (0);
614 1.1.2.1 nisimura #undef cc
615 1.1.2.1 nisimura }
616 1.1.2.1 nisimura
617 1.1.2.1 nisimura static int
618 1.1.2.1 nisimura get_cursor(sc, p)
619 1.1.2.1 nisimura struct pm_softc *sc;
620 1.1.2.1 nisimura struct wsdisplay_cursor *p;
621 1.1.2.1 nisimura {
622 1.1.2.1 nisimura return (ENOTTY); /* XXX */
623 1.1.2.1 nisimura }
624 1.1.2.1 nisimura
625 1.1.2.15 nisimura static void
626 1.1.2.1 nisimura set_curpos(sc, curpos)
627 1.1.2.1 nisimura struct pm_softc *sc;
628 1.1.2.1 nisimura struct wsdisplay_curpos *curpos;
629 1.1.2.1 nisimura {
630 1.1.2.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
631 1.1.2.1 nisimura int x = curpos->x, y = curpos->y;
632 1.1.2.1 nisimura
633 1.1.2.1 nisimura if (y < 0)
634 1.1.2.1 nisimura y = 0;
635 1.1.2.4 nisimura else if (y > dc->dc_ht)
636 1.1.2.4 nisimura y = dc->dc_ht;
637 1.1.2.1 nisimura if (x < 0)
638 1.1.2.1 nisimura x = 0;
639 1.1.2.4 nisimura else if (x > dc->dc_wid)
640 1.1.2.4 nisimura x = dc->dc_wid;
641 1.1.2.1 nisimura sc->sc_cursor.cc_pos.x = x;
642 1.1.2.1 nisimura sc->sc_cursor.cc_pos.y = y;
643 1.1.2.1 nisimura }
644 1.1.2.1 nisimura
645 1.1.2.15 nisimura static void
646 1.1.2.1 nisimura bt478_loadcmap(sc)
647 1.1.2.1 nisimura struct pm_softc *sc;
648 1.1.2.1 nisimura {
649 1.1.2.1 nisimura int i;
650 1.1.2.15 nisimura struct hwcmap256 *cm = &sc->sc_cmap;
651 1.1.2.13 nisimura struct bt478reg *vdac = sc->sc_vdac;
652 1.1.2.1 nisimura
653 1.1.2.13 nisimura vdac->bt_mapWA = 0; kn01_wbflush();
654 1.1.2.1 nisimura for (i = 0; i < CMAP_SIZE; i++) {
655 1.1.2.2 nisimura vdac->bt_map = cm->r[i]; kn01_wbflush();
656 1.1.2.2 nisimura vdac->bt_map = cm->g[i]; kn01_wbflush();
657 1.1.2.2 nisimura vdac->bt_map = cm->b[i]; kn01_wbflush();
658 1.1.2.1 nisimura }
659 1.1.2.1 nisimura }
660 1.1.2.1 nisimura
661 1.1.2.15 nisimura static void
662 1.1.2.1 nisimura bt478_load_curcmap(sc)
663 1.1.2.1 nisimura struct pm_softc *sc;
664 1.1.2.1 nisimura {
665 1.1.2.1 nisimura u_int8_t *cp = sc->sc_cursor.cc_color;
666 1.1.2.13 nisimura struct bt478reg *vdac = sc->sc_vdac;
667 1.1.2.1 nisimura
668 1.1.2.2 nisimura vdac->bt_overWA = 0x04; kn01_wbflush();
669 1.1.2.2 nisimura vdac->bt_over = cp[1]; kn01_wbflush();
670 1.1.2.2 nisimura vdac->bt_over = cp[3]; kn01_wbflush();
671 1.1.2.2 nisimura vdac->bt_over = cp[5]; kn01_wbflush();
672 1.1.2.2 nisimura
673 1.1.2.2 nisimura vdac->bt_overWA = 0x08; kn01_wbflush();
674 1.1.2.2 nisimura vdac->bt_over = 0x00; kn01_wbflush();
675 1.1.2.2 nisimura vdac->bt_over = 0x00; kn01_wbflush();
676 1.1.2.2 nisimura vdac->bt_over = 0x7f; kn01_wbflush();
677 1.1.2.2 nisimura
678 1.1.2.2 nisimura vdac->bt_overWA = 0x0c; kn01_wbflush();
679 1.1.2.2 nisimura vdac->bt_over = cp[0]; kn01_wbflush();
680 1.1.2.2 nisimura vdac->bt_over = cp[2]; kn01_wbflush();
681 1.1.2.2 nisimura vdac->bt_over = cp[4]; kn01_wbflush();
682 1.1.2.1 nisimura }
683 1.1.2.1 nisimura
684 1.1.2.15 nisimura static void
685 1.1.2.1 nisimura pcc_load_curshape(sc)
686 1.1.2.1 nisimura struct pm_softc *sc;
687 1.1.2.1 nisimura {
688 1.1.2.13 nisimura struct pccreg *pcc = sc->sc_pcc;
689 1.1.2.7 nisimura u_int32_t *bp;
690 1.1.2.1 nisimura int i;
691 1.1.2.1 nisimura
692 1.1.2.1 nisimura pcc->pcc_cmdr = sc->sc_pcccmdr | PCC_LODSA;
693 1.1.2.11 nisimura kn01_wbflush();
694 1.1.2.1 nisimura bp = sc->sc_cursor.cc_image;
695 1.1.2.12 nisimura for (i = 0; i < sizeof(sc->sc_cursor.cc_image); i+=sizeof(u_int32_t)) {
696 1.1.2.7 nisimura pcc->pcc_memory = (u_int16_t)*bp++;
697 1.1.2.11 nisimura kn01_wbflush();
698 1.1.2.1 nisimura }
699 1.1.2.1 nisimura pcc->pcc_cmdr = sc->sc_pcccmdr;
700 1.1.2.1 nisimura }
701 1.1.2.1 nisimura
702 1.1.2.15 nisimura static void
703 1.1.2.1 nisimura pcc_set_curpos(sc)
704 1.1.2.1 nisimura struct pm_softc *sc;
705 1.1.2.1 nisimura {
706 1.1.2.13 nisimura struct pccreg *pcc = sc->sc_pcc;
707 1.1.2.1 nisimura
708 1.1.2.4 nisimura pcc->pcc_xpos = sc->sc_cursor.cc_pos.x + sc->magic_x;
709 1.1.2.4 nisimura pcc->pcc_ypos = sc->sc_cursor.cc_pos.y + sc->magic_y;
710 1.1.2.1 nisimura }
711 1.1.2.1 nisimura
712 1.1.2.15 nisimura static void
713 1.1.2.1 nisimura pcc_show_cursor(sc, enable)
714 1.1.2.1 nisimura struct pm_softc *sc;
715 1.1.2.1 nisimura int enable;
716 1.1.2.1 nisimura {
717 1.1.2.13 nisimura struct pccreg *pcc = sc->sc_pcc;
718 1.1.2.1 nisimura
719 1.1.2.1 nisimura if (enable)
720 1.1.2.1 nisimura sc->sc_pcccmdr |= (PCC_ENPA | PCC_ENPB);
721 1.1.2.1 nisimura else
722 1.1.2.1 nisimura sc->sc_pcccmdr &= ~(PCC_ENPA | PCC_ENPB);
723 1.1.2.1 nisimura pcc->pcc_cmdr = sc->sc_pcccmdr;
724 1.1.2.1 nisimura }
725