diff options
author | marius <marius@FreeBSD.org> | 2005-05-21 20:38:26 +0000 |
---|---|---|
committer | marius <marius@FreeBSD.org> | 2005-05-21 20:38:26 +0000 |
commit | 494f0cf7a26aadded9c9e1e347acde751e194375 (patch) | |
tree | f55902948da24b843bdd163bff2cb1ebace1c20e /sys/dev/fb/creator.c | |
parent | 11bd45d4034769f7da949898047699532e42054c (diff) | |
download | FreeBSD-src-494f0cf7a26aadded9c9e1e347acde751e194375.zip FreeBSD-src-494f0cf7a26aadded9c9e1e347acde751e194375.tar.gz |
o creator(4):
- Use register macros instead of magic values in the code. [1]
- Check the return values of OF_getprop() and other stuff that actually
can fail.
- Let the unimplemented video driver methods return ENODEV rather
than 0 so other code isn't tricked into thinking a certain operation
was successfull. In case of e.g. the video driver creator_ioctl()
this caused vidcontrol(1) to return random garbage information.
Remove the TODO macros in the unimplemented video driver methods
which did a printf("%s: unimplemented\n", __func__). Under certain
circumstances these managed to invoke a printf() when a low-level
console device wasn't attached, yet, causing a Fast Data Access MMU
Miss. These macros were only really usefull for development anyway.
- Set the struct video_adapter and struct video_info va_flags and
vi_flags etc. as appropriate.
- In creator_configure() don't rely on hitting the node which is the
chosen console device first when searching the OFW tree for adapters
compatible with this driver. Instead just check whether the chosen
console device is a viable target for this driver. Targets that are
not the console (including additional cards in multi-head configs)
will be attached through creator_upa_attach(). I think this how the
code in creator_configure() was actually meant to work.
Honour the VIO_PROBE_ONLY flag and don't initialise and register the
console device twice when creator_configure() is called a second time
during sc_probe_unit().
Let creator_configure() return the number of the found adapters,
i.e. 1 in case probing succeeds, as it's expected. The return values
of video adapter configure functions however currently aren't checked
so this doesn't make a difference at the moment.
- In creator_upa_attach() don't rely on probing and attaching the
adapter which is the console first, in case there are multiple
adpaters and one of them is the console this could lead into using
the video adapter unit 0 twice.
- Make the check for DACs with inverted cursor control a bit more
precise and actually honour that information when turning the cursor
on or off. Add a helper function creator_cursor_enable() for this
in order to keep code duplication low. [1]
- Don't bother with faking a hardware cursor in case a device is the
console. Apparently this was meant to start kernel output right after
where the firmware left. In general this isn't worth the fuzz and
also had no real effect as creator_set_mode() did clear the screen
in any case, not just in case a device was not the console.
- Implement creator_fill_rect() and use it to actually blank the
display in creator_blank_display() when the mode is V_DISPLAY_BLANK,
moving blanking the display out of creator_set_mode(). Use it also
to implement creator_set_border() so the border can be re-drawn
when switching to a VTY from X, exiting X, etc. (which leaves us
with a black border most of the time).
- Implement the video driver creator_ioctl(), moving the implementation
of the IOCTL interface from the fbN CDEV version of creator_ioctl()
into the video driver version and use the latter to implement the
former. Use fb_commonioctl() to handle most of the FBIO IOCTLs.
This gives programs like vidcontrol(1) which use the video driver
creator_ioctl() a chance of working.
Implement turning off the cursor via the FBIOSCURSOR IOCTL, which
Xorg uses to in order to inform the OS that it's taking over the
cursor. In creator_putm() check whether the cursor is enabled and
(re-)install it if necessary, moving installing the cursor out of
creator_init() and into a helper function creator_cursor_install().
This fixes the missing mouse pointer when switching to a VTY from X,
exiting X, etc.
- Some clean-up (remove unused/useless code, etc.).
o sparc64/creator/creator_upa.c / sparc64/sparc64/sc_machdep.c:
- Attach syscons(4) as an own pseudo-device on the nexus rather than
directly in creator_upa_attach(), similiar to attaching syscons(4)
as a pseudo-device on isa(4) on other archs. This makes it a whole
lot easier to do the right thing in multi-head configs, especially
with different types of graphics adapters. [2]
- Set SC_AUTODETECT_KBD by default so USB keyboards work out of the
box. [2]
Based on/obtained from: Xorg 'ffb' driver [1]
Based on/obtained from: FreeBSD/powerpc [2]
Diffstat (limited to 'sys/dev/fb/creator.c')
-rw-r--r-- | sys/dev/fb/creator.c | 393 |
1 files changed, 236 insertions, 157 deletions
diff --git a/sys/dev/fb/creator.c b/sys/dev/fb/creator.c index 00cf414..13c894e 100644 --- a/sys/dev/fb/creator.c +++ b/sys/dev/fb/creator.c @@ -22,22 +22,22 @@ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. - * - * $FreeBSD$ */ +#include <sys/cdefs.h> +__FBSDID("$FreeBSD$"); + #include <sys/param.h> #include <sys/systm.h> #include <sys/bus.h> -#include <sys/fbio.h> #include <sys/consio.h> +#include <sys/fbio.h> #include <sys/kernel.h> #include <sys/module.h> #include <machine/bus.h> #include <machine/ofw_upa.h> - -#include <sys/rman.h> +#include <machine/sc_machdep.h> #include <dev/fb/fbreg.h> #include <dev/fb/gallant12x22.h> @@ -85,6 +85,8 @@ static void creator_ras_fifo_wait(struct creator_softc *sc, int n); static void creator_ras_setbg(struct creator_softc *sc, int bg); static void creator_ras_setfg(struct creator_softc *sc, int fg); static void creator_ras_wait(struct creator_softc *sc); +static void creator_cursor_enable(struct creator_softc *, int); +static void creator_cursor_install(struct creator_softc *); static video_switch_t creatorvidsw = { .probe = creator_probe, @@ -151,7 +153,30 @@ static int cmap[] = { C(0xff, 0xff, 0xff), /* white */ }; -#define TODO printf("%s: unimplemented\n", __func__) +static u_char creator_mouse_pointer[64][8] __aligned(8) = { + { 0x00, 0x00, }, /* ............ */ + { 0x80, 0x00, }, /* *........... */ + { 0xc0, 0x00, }, /* **.......... */ + { 0xe0, 0x00, }, /* ***......... */ + { 0xf0, 0x00, }, /* ****........ */ + { 0xf8, 0x00, }, /* *****....... */ + { 0xfc, 0x00, }, /* ******...... */ + { 0xfe, 0x00, }, /* *******..... */ + { 0xff, 0x00, }, /* ********.... */ + { 0xff, 0x80, }, /* *********... */ + { 0xfc, 0xc0, }, /* ******..**.. */ + { 0xdc, 0x00, }, /* **.***...... */ + { 0x8e, 0x00, }, /* *...***..... */ + { 0x0e, 0x00, }, /* ....***..... */ + { 0x07, 0x00, }, /* .....***.... */ + { 0x04, 0x00, }, /* .....*...... */ + { 0x00, 0x00, }, /* ............ */ + { 0x00, 0x00, }, /* ............ */ + { 0x00, 0x00, }, /* ............ */ + { 0x00, 0x00, }, /* ............ */ + { 0x00, 0x00, }, /* ............ */ + { 0x00, 0x00, }, /* ............ */ +}; static struct creator_softc creator_softc; @@ -161,72 +186,57 @@ creator_configure(int flags) struct upa_regs reg[FFB_NREG]; struct creator_softc *sc; phandle_t chosen; + phandle_t output; ihandle_t stdout; - phandle_t child; char buf[32]; int i; sc = &creator_softc; - for (child = OF_child(OF_peer(0)); child != 0; - child = OF_peer(child)) { - OF_getprop(child, "name", buf, sizeof(buf)); - if (strcmp(buf, "SUNW,ffb") == 0 || - strcmp(buf, "SUNW,afb") == 0) - break; - } - if (child == 0) + if ((chosen = OF_finddevice("/chosen")) == -1) + return (0); + if (OF_getprop(chosen, "stdout", &stdout, sizeof(stdout)) == -1) + return (0); + if ((output = OF_instance_to_package(stdout)) == -1) + return (0); + if (OF_getprop(output, "name", buf, sizeof(buf)) == -1) + return (0); + if (strcmp(buf, "SUNW,ffb") == 0 || strcmp(buf, "SUNW,afb") == 0) { + /* + * When being called a second time, i.e. during + * sc_probe_unit(), just return at this point. + * Note that the polarity of the VIO_PROBE_ONLY + * flag is somewhat non-intuitive. + */ + if (!(flags & VIO_PROBE_ONLY)) + goto found; + if (strcmp(buf, "SUNW,afb") == 0) + sc->sc_flags |= CREATOR_AFB; + sc->sc_node = output; + } else return (0); - chosen = OF_finddevice("/chosen"); - OF_getprop(chosen, "stdout", &stdout, sizeof(stdout)); - if (child == OF_instance_to_package(stdout)) - sc->sc_console = 1; - - OF_getprop(child, "reg", reg, sizeof(reg)); + if (OF_getprop(output, "reg", reg, sizeof(reg)) == -1) + return (0); for (i = 0; i < FFB_NREG; i++) { sc->sc_bt[i] = &nexus_bustag; sc->sc_bh[i] = UPA_REG_PHYS(reg + i); } - OF_getprop(child, "height", &sc->sc_height, sizeof(sc->sc_height)); - OF_getprop(child, "width", &sc->sc_width, sizeof(sc->sc_width)); - creator_init(0, &sc->sc_va, 0); + if (creator_init(0, &sc->sc_va, 0) < 0) + return (0); - return (0); + found: + /* Return number of found adapters. */ + return (1); } static int -creator_probe(int unit, video_adapter_t **adp, void *arg, int flags) +creator_probe(int unit, video_adapter_t **adpp, void *arg, int flags) { - TODO; + return (0); } -static u_char creator_mouse_pointer[64][8] __aligned(8) = { - { 0x00, 0x00, }, /* ............ */ - { 0x80, 0x00, }, /* *........... */ - { 0xc0, 0x00, }, /* **.......... */ - { 0xe0, 0x00, }, /* ***......... */ - { 0xf0, 0x00, }, /* ****........ */ - { 0xf8, 0x00, }, /* *****....... */ - { 0xfc, 0x00, }, /* ******...... */ - { 0xfe, 0x00, }, /* *******..... */ - { 0xff, 0x00, }, /* ********.... */ - { 0xff, 0x80, }, /* *********... */ - { 0xfc, 0xc0, }, /* ******..**.. */ - { 0xdc, 0x00, }, /* **.***...... */ - { 0x8e, 0x00, }, /* *...***..... */ - { 0x0e, 0x00, }, /* ....***..... */ - { 0x07, 0x00, }, /* .....***.... */ - { 0x04, 0x00, }, /* .....*...... */ - { 0x00, 0x00, }, /* ............ */ - { 0x00, 0x00, }, /* ............ */ - { 0x00, 0x00, }, /* ............ */ - { 0x00, 0x00, }, /* ............ */ - { 0x00, 0x00, }, /* ............ */ - { 0x00, 0x00, }, /* ............ */ -}; - static int creator_init(int unit, video_adapter_t *adp, int flags) { @@ -234,22 +244,30 @@ creator_init(int unit, video_adapter_t *adp, int flags) phandle_t options; video_info_t *vi; char buf[32]; - cell_t col; - cell_t row; - int i, j; sc = (struct creator_softc *)adp; vi = &adp->va_info; - vid_init_struct(adp, "creator", -1, unit); - - options = OF_finddevice("/options"); - OF_getprop(options, "screen-#rows", buf, sizeof(buf)); + vid_init_struct(adp, CREATOR_DRIVER_NAME, -1, unit); + + if (OF_getprop(sc->sc_node, "height", &sc->sc_height, + sizeof(sc->sc_height)) == -1) + return (ENXIO); + if (OF_getprop(sc->sc_node, "width", &sc->sc_width, + sizeof(sc->sc_width)) == -1) + return (ENXIO); + if ((options = OF_finddevice("/options")) == -1) + return (ENXIO); + if (OF_getprop(options, "screen-#rows", buf, sizeof(buf)) == -1) + return (ENXIO); vi->vi_height = strtol(buf, NULL, 10); - OF_getprop(options, "screen-#columns", buf, sizeof(buf)); + if (OF_getprop(options, "screen-#columns", buf, sizeof(buf)) == -1) + return (ENXIO); vi->vi_width = strtol(buf, NULL, 10); vi->vi_cwidth = 12; vi->vi_cheight = 22; + vi->vi_flags = V_INFO_COLOR; + vi->vi_mem_model = V_INFO_MM_OTHER; sc->sc_font = gallant12x22_data; sc->sc_xmargin = (sc->sc_width - (vi->vi_width * vi->vi_cwidth)) / 2; @@ -267,42 +285,30 @@ creator_init(int unit, video_adapter_t *adp, int flags) FFB_WRITE(sc, FFB_FBC, FFB_FBC_FBC, FFB_FBC_WB_A | FFB_FBC_RB_A | FFB_FBC_SB_BOTH | FFB_FBC_XE_OFF | FFB_FBC_RGBE_MASK); - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, 0x8000); - sc->sc_dac = (FFB_READ(sc, FFB_DAC, FFB_DAC_VALUE) >> 0x1c); - - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, 0x102); - FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, 0xffffff); - FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, 0x0); - - for (i = 0; i < 2; i++) { - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, i ? 0x0 : 0x80); - for (j = 0; j < 64; j++) { - FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, - *(uint32_t *)(&creator_mouse_pointer[j][0])); - FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, - *(uint32_t *)(&creator_mouse_pointer[j][4])); - } - } - - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, 0x100); - FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, 0x0); - - if (sc->sc_console) { - col = 0; - row = 0; - OF_interpret("stdout @ is my-self addr line# addr column# ", - 2, &col, &row); - if (col != 0 && row != 0) { - sc->sc_colp = (int *)(col + 4); - sc->sc_rowp = (int *)(row + 4); + if (!(sc->sc_flags & CREATOR_AFB)) { + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, FFB_DAC_CFG_DID); + if (((FFB_READ(sc, FFB_DAC, FFB_DAC_VALUE) & + FFB_DAC_CFG_DID_PNUM) >> 12) != 0x236e) { + sc->sc_flags |= CREATOR_PAC1; + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, FFB_DAC_CFG_UCTRL); + if (((FFB_READ(sc, FFB_DAC, FFB_DAC_VALUE) & + FFB_DAC_UCTRL_MANREV) >> 8) <= 2) + sc->sc_flags |= CREATOR_CURINV; } - } else { - creator_blank_display(&sc->sc_va, V_DISPLAY_ON); } - creator_set_mode(&sc->sc_va, 0); + /* + * FFB_DAC_CFG_TGEN_VIDE must be turned on for creator_set_mode() + * to take effect. + */ + creator_blank_display(adp, V_DISPLAY_ON); + creator_set_mode(adp, 0); + creator_blank_display(adp, V_DISPLAY_BLANK); - vid_register(&sc->sc_va); + adp->va_flags |= V_ADP_COLOR | V_ADP_BORDER | V_ADP_INITIALIZED; + if (vid_register(adp) < 0) + return (ENXIO); + adp->va_flags |= V_ADP_REGISTERED; return (0); } @@ -310,6 +316,7 @@ creator_init(int unit, video_adapter_t *adp, int flags) static int creator_get_info(video_adapter_t *adp, int mode, video_info_t *info) { + bcopy(&adp->va_info, info, sizeof(*info)); return (0); } @@ -317,8 +324,8 @@ creator_get_info(video_adapter_t *adp, int mode, video_info_t *info) static int creator_query_mode(video_adapter_t *adp, video_info_t *info) { - TODO; - return (0); + + return (ENODEV); } static int @@ -335,13 +342,6 @@ creator_set_mode(video_adapter_t *adp, int mode) creator_ras_setbg(sc, 0x0); creator_ras_setfg(sc, 0xffffff); - - creator_ras_fifo_wait(sc, 4); - FFB_WRITE(sc, FFB_FBC, FFB_FBC_BX, 0); - FFB_WRITE(sc, FFB_FBC, FFB_FBC_BY, 0); - FFB_WRITE(sc, FFB_FBC, FFB_FBC_BH, sc->sc_height); - FFB_WRITE(sc, FFB_FBC, FFB_FBC_BW, sc->sc_width); - creator_ras_wait(sc); return (0); @@ -351,101 +351,97 @@ static int creator_save_font(video_adapter_t *adp, int page, int size, u_char *data, int c, int count) { - TODO; - return (0); + + return (ENODEV); } static int creator_load_font(video_adapter_t *adp, int page, int size, u_char *data, int c, int count) { - TODO; - return (0); + + return (ENODEV); } static int creator_show_font(video_adapter_t *adp, int page) { - TODO; - return (0); + + return (ENODEV); } static int creator_save_palette(video_adapter_t *adp, u_char *palette) { - /* TODO; */ - return (0); + + return (ENODEV); } static int creator_load_palette(video_adapter_t *adp, u_char *palette) { - /* TODO; */ - return (0); + + return (ENODEV); } static int creator_set_border(video_adapter_t *adp, int border) { - /* TODO; */ + struct creator_softc *sc; + + sc = (struct creator_softc *)adp; + creator_fill_rect(adp, border, 0, 0, sc->sc_width, sc->sc_ymargin); + creator_fill_rect(adp, border, 0, sc->sc_height - sc->sc_ymargin, + sc->sc_width, sc->sc_ymargin); + creator_fill_rect(adp, border, 0, 0, sc->sc_xmargin, sc->sc_height); + creator_fill_rect(adp, border, sc->sc_width - sc->sc_xmargin, 0, + sc->sc_xmargin, sc->sc_height); return (0); } static int creator_save_state(video_adapter_t *adp, void *p, size_t size) { - TODO; - return (0); + + return (ENODEV); } static int creator_load_state(video_adapter_t *adp, void *p) { - TODO; - return (0); + + return (ENODEV); } static int creator_set_win_org(video_adapter_t *adp, off_t offset) { - TODO; - return (0); + + return (ENODEV); } static int creator_read_hw_cursor(video_adapter_t *adp, int *col, int *row) { - struct creator_softc *sc; - sc = (struct creator_softc *)adp; - if (sc->sc_colp != NULL && sc->sc_rowp != NULL) { - *col = *sc->sc_colp; - *row = *sc->sc_rowp; - } else { - *col = 0; - *row = 0; - } + *col = 0; + *row = 0; return (0); } static int creator_set_hw_cursor(video_adapter_t *adp, int col, int row) { - struct creator_softc *sc; - sc = (struct creator_softc *)adp; - if (sc->sc_colp != NULL && sc->sc_rowp != NULL) { - *sc->sc_colp = col; - *sc->sc_rowp = row; - } - return (0); + return (ENODEV); } static int creator_set_hw_cursor_shape(video_adapter_t *adp, int base, int height, int celsize, int blink) { - return (0); + + return (ENODEV); } static int @@ -455,14 +451,17 @@ creator_blank_display(video_adapter_t *adp, int mode) int v; sc = (struct creator_softc *)adp; - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, 0x6000); + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, FFB_DAC_CFG_TGEN); v = FFB_READ(sc, FFB_DAC, FFB_DAC_VALUE); - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, 0x6000); - if (mode == V_DISPLAY_ON) - v |= 0x1; + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE, FFB_DAC_CFG_TGEN); + if (mode == V_DISPLAY_ON || mode == V_DISPLAY_BLANK) + v |= FFB_DAC_CFG_TGEN_VIDE; else - v &= ~0x1; + v &= ~FFB_DAC_CFG_TGEN_VIDE; FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE, v); + if (mode == V_DISPLAY_BLANK) + creator_fill_rect(adp, (SC_NORM_ATTR >> 4) & 0xf, 0, 0, + sc->sc_width, sc->sc_height); return (0); } @@ -470,72 +469,113 @@ static int creator_mmap(video_adapter_t *adp, vm_offset_t offset, vm_paddr_t *paddr, int prot) { - TODO; - return (0); + + return (EINVAL); } static int creator_ioctl(video_adapter_t *adp, u_long cmd, caddr_t data) { - TODO; + struct creator_softc *sc; + struct fbcursor *fbc; + struct fbtype *fb; + + sc = (struct creator_softc *)adp; + switch (cmd) { + case FBIOGTYPE: + fb = (struct fbtype *)data; + fb->fb_type = FBTYPE_CREATOR; + fb->fb_height = sc->sc_height; + fb->fb_width = sc->sc_width; + fb->fb_depth = fb->fb_cmsize = fb->fb_size = 0; + break; + case FBIOSCURSOR: + fbc = (struct fbcursor *)data; + if (fbc->set & FB_CUR_SETCUR) { + if (fbc->enable == 0) { + creator_cursor_enable(sc, 0); + sc->sc_flags &= ~CREATOR_CUREN; + } else + return (ENODEV); + } + break; + default: + return (fb_commonioctl(adp, cmd, data)); + } return (0); } static int creator_clear(video_adapter_t *adp) { - TODO; + return (0); } static int creator_fill_rect(video_adapter_t *adp, int val, int x, int y, int cx, int cy) { - TODO; + struct creator_softc *sc; + + sc = (struct creator_softc *)adp; + creator_ras_fifo_wait(sc, 2); + FFB_WRITE(sc, FFB_FBC, FFB_FBC_ROP, FBC_ROP_NEW); + FFB_WRITE(sc, FFB_FBC, FFB_FBC_DRAWOP, FBC_DRAWOP_RECTANGLE); + creator_ras_setfg(sc, cmap[val & 0xf]); + creator_ras_fifo_wait(sc, 4); + FFB_WRITE(sc, FFB_FBC, FFB_FBC_BX, x); + FFB_WRITE(sc, FFB_FBC, FFB_FBC_BY, y); + FFB_WRITE(sc, FFB_FBC, FFB_FBC_BW, cx); + FFB_WRITE(sc, FFB_FBC, FFB_FBC_BH, cy); + creator_ras_wait(sc); return (0); } static int creator_bitblt(video_adapter_t *adp, ...) { - TODO; + return (0); } static int creator_diag(video_adapter_t *adp, int level) { - TODO; + video_info_t info; + + fb_dump_adp_info(adp->va_name, adp, level); + creator_get_info(adp, 0, &info); + fb_dump_mode_info(adp->va_name, adp, &info, level); return (0); } static int creator_save_cursor_palette(video_adapter_t *adp, u_char *palette) { - TODO; - return (0); + + return (ENODEV); } static int creator_load_cursor_palette(video_adapter_t *adp, u_char *palette) { - TODO; - return (0); + + return (ENODEV); } static int creator_copy(video_adapter_t *adp, vm_offset_t src, vm_offset_t dst, int n) { - TODO; - return (0); + + return (ENODEV); } static int creator_putp(video_adapter_t *adp, vm_offset_t off, u_int32_t p, u_int32_t a, int size, int bpp, int bit_ltor, int byte_ltor) { - TODO; - return (0); + + return (ENODEV); } static int @@ -582,7 +622,12 @@ creator_putm(video_adapter_t *adp, int x, int y, u_int8_t *pixel_image, struct creator_softc *sc; sc = (struct creator_softc *)adp; - FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, 0x104); + if (!(sc->sc_flags & CREATOR_CUREN)) { + creator_cursor_install(sc); + creator_cursor_enable(sc, 1); + sc->sc_flags |= CREATOR_CUREN; + } + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, FFB_DAC_CUR_POS); FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, ((y + sc->sc_ymargin) << 16) | (x + sc->sc_xmargin)); return (0); @@ -633,7 +678,7 @@ creator_ras_wait(struct creator_softc *sc) for (;;) { ucsr = FFB_READ(sc, FFB_FBC, FFB_FBC_UCSR); - if ((ucsr & (FBC_UCSR_FB_BUSY|FBC_UCSR_RP_BUSY)) == 0) + if ((ucsr & (FBC_UCSR_FB_BUSY | FBC_UCSR_RP_BUSY)) == 0) break; r = ucsr & (FBC_UCSR_READ_ERR | FBC_UCSR_FIFO_OVFL); if (r != 0) { @@ -641,3 +686,37 @@ creator_ras_wait(struct creator_softc *sc) } } } + +static void +creator_cursor_enable(struct creator_softc *sc, int onoff) +{ + int v; + + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, FFB_DAC_CUR_CTRL); + if (sc->sc_flags & CREATOR_CURINV) + v = onoff ? FFB_DAC_CUR_CTRL_P0 | FFB_DAC_CUR_CTRL_P1 : 0; + else + v = onoff ? 0 : FFB_DAC_CUR_CTRL_P0 | FFB_DAC_CUR_CTRL_P1; + FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, v); +} + +static void +creator_cursor_install(struct creator_softc *sc) +{ + int i, j; + + creator_cursor_enable(sc, 0); + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, FFB_DAC_CUR_COLOR1); + FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, 0xffffff); + FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, 0x0); + for (i = 0; i < 2; i++) { + FFB_WRITE(sc, FFB_DAC, FFB_DAC_TYPE2, + i ? FFB_DAC_CUR_BITMAP_P0 : FFB_DAC_CUR_BITMAP_P1); + for (j = 0; j < 64; j++) { + FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, + *(uint32_t *)(&creator_mouse_pointer[j][0])); + FFB_WRITE(sc, FFB_DAC, FFB_DAC_VALUE2, + *(uint32_t *)(&creator_mouse_pointer[j][4])); + } + } +} |