/* $NetBSD: ite_cc.c,v 1.40 2018/09/03 16:29:22 riastradh Exp $ */ /* * Copyright (c) 1994 Christian E. Hopps * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by Christian E. Hopps. * 4. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 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. */ #include "opt_amigaccgrf.h" #include __KERNEL_RCSID(0, "$NetBSD: ite_cc.c,v 1.40 2018/09/03 16:29:22 riastradh Exp $"); #include "grfcc.h" #if NGRFCC > 0 #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifndef KFONT_CUSTOM #ifdef KFONT_8X11 #define kernel_font_width kernel_font_width_8x11 #define kernel_font_height kernel_font_height_8x11 #define kernel_font_baseline kernel_font_baseline_8x11 #define kernel_font_boldsmear kernel_font_boldsmear_8x11 #define kernel_font_lo kernel_font_lo_8x11 #define kernel_font_hi kernel_font_hi_8x11 #define kernel_font kernel_font_8x11 #define kernel_cursor kernel_cursor_8x11 #else #define kernel_font_width kernel_font_width_8x8 #define kernel_font_height kernel_font_height_8x8 #define kernel_font_baseline kernel_font_baseline_8x8 #define kernel_font_boldsmear kernel_font_boldsmear_8x8 #define kernel_font_lo kernel_font_lo_8x8 #define kernel_font_hi kernel_font_hi_8x8 #define kernel_font kernel_font_8x8 #define kernel_cursor kernel_cursor_8x8 #endif #endif extern u_char kernel_font_width, kernel_font_height, kernel_font_baseline; extern short kernel_font_boldsmear; extern u_char kernel_font_lo, kernel_font_hi; extern u_char kernel_font[], kernel_cursor[]; #if !defined(USE_C_BFOPS) && !defined(__m68k__) #define USE_C_BFOPS #endif #if !defined(USE_C_BFOPS) #define BFEXT(v,p,o,w) __asm("bfextu %1@{%2:%3},%0" : "=d" (v) : \ "a"(p), "d"(o), "d"(w)) #define BFINS(v,p,o,w) __asm("bfins %0,%1@{%2:%3}" : /* no output */ : \ "d"(v), "a"(p), "d"(o), "d"(w)) #define BFCLR(p,o,w) __asm("bfclr %0@{%1:%2}" : /* no output */ : \ "a"(p), "d"(o), "d"(w)) #define BFCHG(p,o,w) __asm("bfchg %0@{%1:%2}" : /* no output */ : \ "a"(p), "d"(o), "d"(w)) #define BFSET(p,o,w) __asm("bfset %0@{%1:%2}" : /* no output */ : \ "a"(p), "d"(o), "d"(w)) #else #define BFEXT(v,p,o,w) do {v = ((u_int8_t *)(p))[(o)>>3];} while (0) #define BFINS(v,p,o,w) do {((u_int8_t *)(p))[(o)>>3] = (v);} while (0) #define BFCLR(p,o,w) BFINS(0x00,p,o,w) #define BFSET(p,o,w) BFINS(0xff,p,o,w) #define BFCHG(p,o,w) do {((u_int8_t *)(p))[(o)>>3] ^= 0xff;} while (0) #endif /* * This is what ip->priv points to; * it contains local variables for custom-chip ites. */ struct ite_priv { view_t *view; /* the view for this ite. */ u_char **row_ptr; /* array of pointers into the bitmap */ u_long row_bytes; u_long cursor_opt; u_int *column_offset; /* array of offsets for columns */ u_int row_offset; /* the row offset */ u_short width; /* the bitmap width */ u_short underline; /* where the underline goes */ u_short ft_x; /* the font width */ u_short ft_y; /* the font height */ u_char *font_cell[256]; /* the font pointer */ }; typedef struct ite_priv ipriv_t; void view_deinit(struct ite_softc *); void view_init(struct ite_softc *); static void putc8(struct ite_softc *, int, int, int, int); static void clear8(struct ite_softc *, int, int, int, int); static void scroll8(struct ite_softc *, int, int, int, int); static void cursor32(struct ite_softc *, int); static void scrollbmap(bmap_t *, u_short, u_short, u_short, u_short, short, short, u_char); /* patchable */ int ite_default_x = 0; /* def leftedge offset */ int ite_default_y = 0; /* def topedge offset */ int ite_default_width = 640; /* def width */ int ite_default_depth = 2; /* def depth */ #if defined (GRF_NTSC) int ite_default_height = 400; /* def NTSC height */ #elif defined (GRF_PAL) int ite_default_height = 512; /* def PAL height */ #else int ite_default_height = 400; /* def NON-PAL/NTSC height (?) */ #endif int ite_newsize(struct ite_softc *, struct itewinsize *); static void putc_nm(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_in(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_ul(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_ul_in(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_bd(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_bd_in(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_bd_ul(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); static void putc_bd_ul_in(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); /* * called from grf_cc to return console priority */ int grfcc_cnprobe(void) { return(CN_INTERNAL); } /* * called from grf_cc to init ite portion of * grf_softc struct */ void grfcc_iteinit(struct grf_softc *gp) { gp->g_itecursor = cursor32; gp->g_iteputc = putc8; gp->g_iteclear = clear8; gp->g_itescroll = scroll8; gp->g_iteinit = view_init; gp->g_itedeinit = view_deinit; } int ite_newsize(struct ite_softc *ip, struct itewinsize *winsz) { extern struct view_softc views[]; extern const struct cdevsw view_cdevsw; struct view_size vs; ipriv_t *cci = ip->priv; u_long i; int error; vs.x = winsz->x; vs.y = winsz->y; vs.width = winsz->width; vs.height = winsz->height; vs.depth = winsz->depth; /* XXX type of vs ? */ error = (*view_cdevsw.d_ioctl)(0, VIOCSSIZE, (void *)&vs, -1, NULL); /* * Reinitialize our structs */ cci->view = views[0].view; ip->cols = cci->view->display.width / ip->ftwidth; ip->rows = cci->view->display.height / ip->ftheight; /* * save new values so that future opens use them * this may not be correct when we implement Virtual Consoles */ ite_default_height = cci->view->display.height; ite_default_width = cci->view->display.width; ite_default_x = cci->view->display.x; ite_default_y = cci->view->display.y; ite_default_depth = cci->view->bitmap->depth; if (cci->row_ptr) free_chipmem(cci->row_ptr); if (cci->column_offset) free_chipmem(cci->column_offset); cci->row_ptr = alloc_chipmem(sizeof(u_char *) * ip->rows); cci->column_offset = alloc_chipmem(sizeof(u_int) * ip->cols); if (cci->row_ptr == NULL || cci->column_offset == NULL) panic("no chipmem for itecc data"); cci->width = cci->view->bitmap->bytes_per_row << 3; cci->underline = ip->ftbaseline + 1; cci->row_offset = cci->view->bitmap->bytes_per_row + cci->view->bitmap->row_mod; cci->ft_x = ip->ftwidth; cci->ft_y = ip->ftheight; cci->row_bytes = cci->row_offset * ip->ftheight; cci->row_ptr[0] = VDISPLAY_LINE (cci->view, 0, 0); for (i = 1; i < ip->rows; i++) cci->row_ptr[i] = cci->row_ptr[i-1] + cci->row_bytes; /* initialize the column offsets */ cci->column_offset[0] = 0; for (i = 1; i < ip->cols; i++) cci->column_offset[i] = cci->column_offset[i - 1] + cci->ft_x; /* initialize the font cell pointers */ cci->font_cell[ip->font_lo] = ip->font; for (i=ip->font_lo+1; i<=ip->font_hi; i++) cci->font_cell[i] = cci->font_cell[i-1] + ip->ftheight; return (error); } void view_init(register struct ite_softc *ip) { struct itewinsize wsz; ipriv_t *cci; cci = ip->priv; if (cci) return; ip->font = kernel_font; ip->font_lo = kernel_font_lo; ip->font_hi = kernel_font_hi; ip->ftwidth = kernel_font_width; ip->ftheight = kernel_font_height; ip->ftbaseline = kernel_font_baseline; ip->ftboldsmear = kernel_font_boldsmear; /* Find the correct set of rendering routines for this font. */ if (ip->ftwidth > 8) panic("kernel font size not supported"); cci = alloc_chipmem(sizeof (*cci)); if (cci == NULL) panic("no memory for console device."); ip->priv = cci; cci->cursor_opt = 0; cci->view = NULL; cci->row_ptr = NULL; cci->column_offset = NULL; wsz.x = ite_default_x; wsz.y = ite_default_y; wsz.width = ite_default_width; wsz.height = ite_default_height; wsz.depth = ite_default_depth; ite_newsize (ip, &wsz); cc_mode(ip->grf, GM_GRFON, NULL, 0, 0); } int ite_grf_ioctl(struct ite_softc *ip, u_long cmd, void *addr, int flag, struct lwp *l) { struct winsize ws; struct itewinsize *is; extern const struct cdevsw ite_cdevsw; extern const struct cdevsw view_cdevsw; ipriv_t *cci; int error; cci = ip->priv; error = 0; switch (cmd) { case ITEIOCGWINSZ: is = (struct itewinsize *)addr; is->x = cci->view->display.x; is->y = cci->view->display.y; is->width = cci->view->display.width; is->height = cci->view->display.height; is->depth = cci->view->bitmap->depth; break; case ITEIOCSWINSZ: is = (struct itewinsize *)addr; if (ite_newsize(ip, is)) error = ENOMEM; else { ws.ws_row = ip->rows; ws.ws_col = ip->cols; ws.ws_xpixel = cci->view->display.width; ws.ws_ypixel = cci->view->display.height; ite_reset (ip); /* * XXX tell tty about the change * XXX this is messy, but works */ (*ite_cdevsw.d_ioctl)(0, TIOCSWINSZ, (void *)&ws, 0, l); } break; case ITEIOCDSPWIN: cc_mode(ip->grf, GM_GRFON, NULL, 0, 0); break; case ITEIOCREMWIN: cc_mode(ip->grf, GM_GRFOFF, NULL, 0, 0); break; case VIOCSCMAP: case VIOCGCMAP: /* * XXX needs to be fixed when multiple console implemented * XXX watchout for that -1 its not really the kernel talking * XXX these two commands don't use the proc pointer though */ error = (*view_cdevsw.d_ioctl)(0, cmd, addr, -1, l); break; default: error = EPASSTHROUGH; break; } return (error); } void view_deinit(struct ite_softc *ip) { ip->flags &= ~ITE_INITED; } /*** (M<8)-by-N routines ***/ static void cursor32(struct ite_softc *ip, int flag) { int cend, ofs, h, cstart, dr_plane; u_char *pl; ipriv_t *cci; bmap_t *bm; view_t *v; cci = ip->priv; v = cci->view; bm = v->bitmap; dr_plane = (bm->depth > 1 ? bm->depth-1 : 0); if (flag == END_CURSOROPT) cci->cursor_opt--; else if (flag == START_CURSOROPT) { if (!cci->cursor_opt) cursor32 (ip, ERASE_CURSOR); cci->cursor_opt++; return; /* if we are already opted. */ } if (cci->cursor_opt) return; /* if we are still nested. */ /* else we draw the cursor. */ cstart = 0; cend = ip->ftheight-1; pl = VDISPLAY_LINE(v, dr_plane, (ip->cursory * ip->ftheight + cstart)); ofs = (ip->cursorx * ip->ftwidth); if (flag != DRAW_CURSOR && flag != END_CURSOROPT) { /* * erase the cursor */ int hh; if (dr_plane) { for (hh = cend; hh >= 0; hh--) { BFCLR(pl, ofs, ip->ftwidth); pl += cci->row_offset; } } else { for (hh = cend; hh >= 0; hh--) { BFCHG(pl, ofs, ip->ftwidth); pl += cci->row_offset; } } } if (flag != DRAW_CURSOR && flag != MOVE_CURSOR && flag != END_CURSOROPT) return; /* * draw the cursor */ ip->cursorx = uimin(ip->curx, ip->cols-1); ip->cursory = ip->cury; cstart = 0; cend = ip->ftheight-1; pl = VDISPLAY_LINE(v, dr_plane, ip->cursory * ip->ftheight + cstart); ofs = ip->cursorx * ip->ftwidth; if (dr_plane) { for (h = cend; h >= 0; h--) { BFSET(pl, ofs, ip->ftwidth); pl += cci->row_offset; } } else { for (h = cend; h >= 0; h--) { BFCHG(pl, ofs, ip->ftwidth); pl += cci->row_offset; } } } static inline int expbits(int data) { int i, nd = 0; if (data & 1) nd |= 0x02; for (i=1; i < 32; i++) { if (data & (1 << i)) nd |= 0x5 << (i-1); } nd &= ~data; return(~nd); } /* Notes: optimizations given the kernel_font_(width|height) #define'd. * the dbra loops could be elminated and unrolled using height, * the :width in the bfxxx instruction could be made immediate instead * of a data register as it now is. * the underline could be added when the loop is unrolled * * It would look like hell but be very fast.*/ static void putc_nm(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { while (fh--) { BFINS(*f++, p, co, fw); p += ro; } } static void putc_in(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { while (fh--) { BFINS(~(*f++), p, co, fw); p += ro; } } static void putc_ul(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { int underline = cci->underline; while (underline--) { BFINS(*f++,p,co,fw); p += ro; } BFINS(expbits(*f++),p,co,fw); p += ro; underline = fh - cci->underline - 1; while (underline--) { BFINS(*f++,p,co,fw); p += ro; } } static void putc_ul_in(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { int underline = cci->underline; while (underline--) { BFINS(~(*f++),p,co,fw); p += ro; } BFINS(~expbits(*f++),p,co,fw); p += ro; underline = fh - cci->underline - 1; while (underline--) { BFINS(~(*f++),p,co,fw); p += ro; } } /* bold */ static void putc_bd(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { u_short ch; while (fh--) { ch = *f++; ch |= ch >> 1; BFINS(ch,p,co,fw); p += ro; } } static void putc_bd_in(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { u_short ch; while (fh--) { ch = *f++; ch |= ch >> 1; BFINS(~ch,p,co,fw); p += ro; } } static void putc_bd_ul(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { int underline = cci->underline; u_short ch; while (underline--) { ch = *f++; ch |= ch >> 1; BFINS(ch,p,co,fw); p += ro; } ch = *f++; ch |= ch >> 1; BFINS(expbits(ch),p,co,fw); p += ro; underline = fh - cci->underline - 1; while (underline--) { ch = *f++; ch |= ch >> 1; BFINS(ch,p,co,fw); p += ro; } } static void putc_bd_ul_in(register ipriv_t *cci, register u_char *p, register u_char *f, register u_int co, register u_int ro, register u_int fw, register u_int fh) { int underline = cci->underline; u_short ch; while (underline--) { ch = *f++; ch |= ch >> 1; BFINS(~ch,p,co,fw); p += ro; } ch = *f++; ch |= ch >> 1; BFINS(~expbits(ch),p,co,fw); p += ro; underline = fh - cci->underline - 1; while (underline--) { ch = *f++; ch |= ch >> 1; BFINS(~ch,p,co,fw); p += ro; } } typedef void cc_putc_func(ipriv_t *, u_char *, u_char *, u_int, u_int, u_int, u_int); cc_putc_func *put_func[ATTR_ALL+1] = { putc_nm, putc_in, putc_ul, putc_ul_in, putc_bd, putc_bd_in, putc_bd_ul, putc_bd_ul_in, /* no support for blink */ putc_nm, putc_in, putc_ul, putc_ul_in, putc_bd, putc_bd_in, putc_bd_ul, putc_bd_ul_in }; /* FIX: shouldn't this advance the cursor even if the character to be output is not available in the font? -ch */ static void putc8(struct ite_softc *ip, int c, int dy, int dx, int mode) { ipriv_t *cci = (ipriv_t *) ip->priv; /* * if character is higher than font has glyphs, substitute * highest glyph. */ c = (u_char)c; if (c < ip->font_lo || c > ip->font_hi) c = ip->font_hi; put_func[mode](cci, cci->row_ptr[dy], cci->font_cell[c], cci->column_offset[dx], cci->row_offset, cci->ft_x, cci->ft_y); } static void clear8(struct ite_softc *ip, int sy, int sx, int h, int w) { ipriv_t *cci = (ipriv_t *) ip->priv; bmap_t *bm = cci->view->bitmap; if ((sx == 0) && (w == ip->cols)) { /* common case: clearing whole lines */ while (h--) { int i; u_char *ptr = cci->row_ptr[sy]; for (i=0; i < ip->ftheight; i++) { memset(ptr, 0, bm->bytes_per_row); ptr += bm->bytes_per_row + bm->row_mod; /* don't get any smart ideas, because this is for interleaved bitmaps */ } sy++; } } else { /* clearing only part of a line */ /* XXX could be optimized MUCH better, but is it worth the trouble? */ while (h--) { u_char *pl = cci->row_ptr[sy]; int ofs = sx * ip->ftwidth; int i, j; for (i = w-1; i >= 0; i--) { u_char *ppl = pl; for (j = ip->ftheight-1; j >= 0; j--) { BFCLR(ppl, ofs, ip->ftwidth); ppl += bm->row_mod + bm->bytes_per_row; } ofs += ip->ftwidth; } sy++; } } } /* Note: sx is only relevant for SCROLL_LEFT or SCROLL_RIGHT. */ static void scroll8(register struct ite_softc *ip, register int sy, int sx, int count, int dir) { bmap_t *bm = ((ipriv_t *)ip->priv)->view->bitmap; u_char *pl = ((ipriv_t *)ip->priv)->row_ptr[sy]; if (dir == SCROLL_UP) { int dy = sy - count; /*FIX: add scroll bitmap call */ cursor32(ip, ERASE_CURSOR); scrollbmap (bm, 0, dy*ip->ftheight, bm->bytes_per_row >> 3, (ip->bottom_margin-dy+1)*ip->ftheight, 0, -(count*ip->ftheight), 0x1); /* if (ip->cursory <= bot || ip->cursory >= dy) { ip->cursory -= count; } */ } else if (dir == SCROLL_DOWN) { /* FIX: add scroll bitmap call */ cursor32(ip, ERASE_CURSOR); scrollbmap (bm, 0, sy*ip->ftheight, bm->bytes_per_row >> 3, (ip->bottom_margin-sy+1)*ip->ftheight, 0, count*ip->ftheight, 0x1); /* if (ip->cursory <= bot || ip->cursory >= sy) { ip->cursory += count; } */ } else if (dir == SCROLL_RIGHT) { int sofs = (ip->cols - count) * ip->ftwidth; int dofs = (ip->cols) * ip->ftwidth; int i, j; cursor32(ip, ERASE_CURSOR); for (j = ip->ftheight-1; j >= 0; j--) { int sofs2 = sofs, dofs2 = dofs; for (i = (ip->cols - (sx + count))-1; i >= 0; i--) { int t; sofs2 -= ip->ftwidth; dofs2 -= ip->ftwidth; BFEXT(t, pl, sofs2, ip->ftwidth); BFINS(t, pl, dofs2, ip->ftwidth); } pl += bm->row_mod + bm->bytes_per_row; } } else /* SCROLL_LEFT */ { int sofs = (sx) * ip->ftwidth; int dofs = (sx - count) * ip->ftwidth; int i, j; cursor32(ip, ERASE_CURSOR); for (j = ip->ftheight-1; j >= 0; j--) { int sofs2 = sofs, dofs2 = dofs; for (i = (ip->cols - sx)-1; i >= 0; i--) { int t; BFEXT(t, pl, sofs2, ip->ftwidth); BFINS(t, pl, dofs2, ip->ftwidth); sofs2 += ip->ftwidth; dofs2 += ip->ftwidth; } pl += bm->row_mod + bm->bytes_per_row; } } } void scrollbmap(bmap_t *bm, u_short x, u_short y, u_short width, u_short height, short dx, short dy, u_char mask) { u_short depth = bm->depth; u_short lwpr = bm->bytes_per_row >> 2; if (dx) { /* FIX: */ panic ("delta x not supported in scroll bitmap yet."); } if (bm->flags & BMF_INTERLEAVED) { height *= depth; depth = 1; } if (dy == 0) { return; } if (dy > 0) { int i; for (i=0; i < depth && mask; i++, mask >>= 1) { if (0x1 & mask) { u_long *pl = (u_long *)bm->plane[i]; u_long *src_y = pl + (lwpr*y); u_long *dest_y = pl + (lwpr*(y+dy)); u_long count = lwpr*(height-dy); u_long *clr_y = src_y; u_long clr_count = dest_y - src_y; u_long bc, cbc; src_y += count - 1; dest_y += count - 1; bc = count >> 4; count &= 0xf; while (bc--) { *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; *dest_y-- = *src_y--; } while (count--) { *dest_y-- = *src_y--; } cbc = clr_count >> 4; clr_count &= 0xf; while (cbc--) { *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; } while (clr_count--) { *clr_y++ = 0; } } } } else if (dy < 0) { int i; for (i=0; i < depth && mask; i++, mask >>= 1) { if (0x1 & mask) { u_long *pl = (u_long *)bm->plane[i]; u_long *src_y = pl + (lwpr*(y-dy)); u_long *dest_y = pl + (lwpr*y); long count = lwpr*(height + dy); u_long *clr_y = dest_y + count; u_long clr_count = src_y - dest_y; u_long bc, cbc; bc = count >> 4; count &= 0xf; while (bc--) { *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; *dest_y++ = *src_y++; } while (count--) { *dest_y++ = *src_y++; } cbc = clr_count >> 4; clr_count &= 0xf; while (cbc--) { *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; *clr_y++ = 0; } while (clr_count--) { *clr_y++ = 0; } } } } } #endif /* NGRFCC */