1/* 2 * linux/drivers/video/console/fbcon_ud.c -- Software Rotation - 90 degrees 3 * 4 * Copyright (C) 2005 Antonino Daplas <adaplas @pol.net> 5 * 6 * This file is subject to the terms and conditions of the GNU General Public 7 * License. See the file COPYING in the main directory of this archive for 8 * more details. 9 */ 10 11#include <linux/module.h> 12#include <linux/slab.h> 13#include <linux/string.h> 14#include <linux/fb.h> 15#include <linux/vt_kern.h> 16#include <linux/console.h> 17#include <asm/types.h> 18#include "fbcon.h" 19#include "fbcon_rotate.h" 20 21/* 22 * Rotation 90 degrees 23 */ 24 25static void cw_update_attr(u8 *dst, u8 *src, int attribute, 26 struct vc_data *vc) 27{ 28 int i, j, offset = (vc->vc_font.height < 10) ? 1 : 2; 29 int width = (vc->vc_font.height + 7) >> 3; 30 u8 c, t = 0, msk = ~(0xff >> offset); 31 32 for (i = 0; i < vc->vc_font.width; i++) { 33 for (j = 0; j < width; j++) { 34 c = *src; 35 if (attribute & FBCON_ATTRIBUTE_UNDERLINE && !j) 36 c |= msk; 37 if (attribute & FBCON_ATTRIBUTE_BOLD && i) 38 c |= *(src-width); 39 if (attribute & FBCON_ATTRIBUTE_REVERSE) 40 c = ~c; 41 src++; 42 *dst++ = c; 43 t = c; 44 } 45 } 46} 47 48 49static void cw_bmove(struct vc_data *vc, struct fb_info *info, int sy, 50 int sx, int dy, int dx, int height, int width) 51{ 52 struct fbcon_ops *ops = info->fbcon_par; 53 struct fb_copyarea area; 54 u32 vxres = GETVXRES(ops->p->scrollmode, info); 55 56 area.sx = vxres - ((sy + height) * vc->vc_font.height); 57 area.sy = sx * vc->vc_font.width; 58 area.dx = vxres - ((dy + height) * vc->vc_font.height); 59 area.dy = dx * vc->vc_font.width; 60 area.width = height * vc->vc_font.height; 61 area.height = width * vc->vc_font.width; 62 63 info->fbops->fb_copyarea(info, &area); 64} 65 66static void cw_clear(struct vc_data *vc, struct fb_info *info, int sy, 67 int sx, int height, int width) 68{ 69 struct fbcon_ops *ops = info->fbcon_par; 70 struct fb_fillrect region; 71 int bgshift = (vc->vc_hi_font_mask) ? 13 : 12; 72 u32 vxres = GETVXRES(ops->p->scrollmode, info); 73 74 region.color = attr_bgcol_ec(bgshift,vc,info); 75 region.dx = vxres - ((sy + height) * vc->vc_font.height); 76 region.dy = sx * vc->vc_font.width; 77 region.height = width * vc->vc_font.width; 78 region.width = height * vc->vc_font.height; 79 region.rop = ROP_COPY; 80 81 info->fbops->fb_fillrect(info, ®ion); 82} 83 84static inline void cw_putcs_aligned(struct vc_data *vc, struct fb_info *info, 85 const u16 *s, u32 attr, u32 cnt, 86 u32 d_pitch, u32 s_pitch, u32 cellsize, 87 struct fb_image *image, u8 *buf, u8 *dst) 88{ 89 struct fbcon_ops *ops = info->fbcon_par; 90 u16 charmask = vc->vc_hi_font_mask ? 0x1ff : 0xff; 91 u32 idx = (vc->vc_font.height + 7) >> 3; 92 u8 *src; 93 94 while (cnt--) { 95 src = ops->fontbuffer + (scr_readw(s++) & charmask)*cellsize; 96 97 if (attr) { 98 cw_update_attr(buf, src, attr, vc); 99 src = buf; 100 } 101 102 if (likely(idx == 1)) 103 __fb_pad_aligned_buffer(dst, d_pitch, src, idx, 104 vc->vc_font.width); 105 else 106 fb_pad_aligned_buffer(dst, d_pitch, src, idx, 107 vc->vc_font.width); 108 109 dst += d_pitch * vc->vc_font.width; 110 } 111 112 info->fbops->fb_imageblit(info, image); 113} 114 115static void cw_putcs(struct vc_data *vc, struct fb_info *info, 116 const unsigned short *s, int count, int yy, int xx, 117 int fg, int bg) 118{ 119 struct fb_image image; 120 struct fbcon_ops *ops = info->fbcon_par; 121 u32 width = (vc->vc_font.height + 7)/8; 122 u32 cellsize = width * vc->vc_font.width; 123 u32 maxcnt = info->pixmap.size/cellsize; 124 u32 scan_align = info->pixmap.scan_align - 1; 125 u32 buf_align = info->pixmap.buf_align - 1; 126 u32 cnt, pitch, size; 127 u32 attribute = get_attribute(info, scr_readw(s)); 128 u8 *dst, *buf = NULL; 129 u32 vxres = GETVXRES(ops->p->scrollmode, info); 130 131 if (!ops->fontbuffer) 132 return; 133 134 image.fg_color = fg; 135 image.bg_color = bg; 136 image.dx = vxres - ((yy + 1) * vc->vc_font.height); 137 image.dy = xx * vc->vc_font.width; 138 image.width = vc->vc_font.height; 139 image.depth = 1; 140 141 if (attribute) { 142 buf = kmalloc(cellsize, GFP_KERNEL); 143 if (!buf) 144 return; 145 } 146 147 while (count) { 148 if (count > maxcnt) 149 cnt = maxcnt; 150 else 151 cnt = count; 152 153 image.height = vc->vc_font.width * cnt; 154 pitch = ((image.width + 7) >> 3) + scan_align; 155 pitch &= ~scan_align; 156 size = pitch * image.height + buf_align; 157 size &= ~buf_align; 158 dst = fb_get_buffer_offset(info, &info->pixmap, size); 159 image.data = dst; 160 cw_putcs_aligned(vc, info, s, attribute, cnt, pitch, 161 width, cellsize, &image, buf, dst); 162 image.dy += image.height; 163 count -= cnt; 164 s += cnt; 165 } 166 167 /* buf is always NULL except when in monochrome mode, so in this case 168 it's a gain to check buf against NULL even though kfree() handles 169 NULL pointers just fine */ 170 if (unlikely(buf)) 171 kfree(buf); 172 173} 174 175static void cw_clear_margins(struct vc_data *vc, struct fb_info *info, 176 int bottom_only) 177{ 178 unsigned int cw = vc->vc_font.width; 179 unsigned int ch = vc->vc_font.height; 180 unsigned int rw = info->var.yres - (vc->vc_cols*cw); 181 unsigned int bh = info->var.xres - (vc->vc_rows*ch); 182 unsigned int rs = info->var.yres - rw; 183 struct fb_fillrect region; 184 int bgshift = (vc->vc_hi_font_mask) ? 13 : 12; 185 186 region.color = attr_bgcol_ec(bgshift,vc,info); 187 region.rop = ROP_COPY; 188 189 if (rw && !bottom_only) { 190 region.dx = 0; 191 region.dy = info->var.yoffset + rs; 192 region.height = rw; 193 region.width = info->var.xres_virtual; 194 info->fbops->fb_fillrect(info, ®ion); 195 } 196 197 if (bh) { 198 region.dx = info->var.xoffset; 199 region.dy = info->var.yoffset; 200 region.height = info->var.yres; 201 region.width = bh; 202 info->fbops->fb_fillrect(info, ®ion); 203 } 204} 205 206static void cw_cursor(struct vc_data *vc, struct fb_info *info, int mode, 207 int softback_lines, int fg, int bg) 208{ 209 struct fb_cursor cursor; 210 struct fbcon_ops *ops = info->fbcon_par; 211 unsigned short charmask = vc->vc_hi_font_mask ? 0x1ff : 0xff; 212 int w = (vc->vc_font.height + 7) >> 3, c; 213 int y = real_y(ops->p, vc->vc_y); 214 int attribute, use_sw = (vc->vc_cursor_type & 0x10); 215 int err = 1, dx, dy; 216 char *src; 217 u32 vxres = GETVXRES(ops->p->scrollmode, info); 218 219 if (!ops->fontbuffer) 220 return; 221 222 cursor.set = 0; 223 224 if (softback_lines) { 225 if (y + softback_lines >= vc->vc_rows) { 226 mode = CM_ERASE; 227 ops->cursor_flash = 0; 228 return; 229 } else 230 y += softback_lines; 231 } 232 233 c = scr_readw((u16 *) vc->vc_pos); 234 attribute = get_attribute(info, c); 235 src = ops->fontbuffer + ((c & charmask) * (w * vc->vc_font.width)); 236 237 if (ops->cursor_state.image.data != src || 238 ops->cursor_reset) { 239 ops->cursor_state.image.data = src; 240 cursor.set |= FB_CUR_SETIMAGE; 241 } 242 243 if (attribute) { 244 u8 *dst; 245 246 dst = kmalloc(w * vc->vc_font.width, GFP_ATOMIC); 247 if (!dst) 248 return; 249 kfree(ops->cursor_data); 250 ops->cursor_data = dst; 251 cw_update_attr(dst, src, attribute, vc); 252 src = dst; 253 } 254 255 if (ops->cursor_state.image.fg_color != fg || 256 ops->cursor_state.image.bg_color != bg || 257 ops->cursor_reset) { 258 ops->cursor_state.image.fg_color = fg; 259 ops->cursor_state.image.bg_color = bg; 260 cursor.set |= FB_CUR_SETCMAP; 261 } 262 263 if (ops->cursor_state.image.height != vc->vc_font.width || 264 ops->cursor_state.image.width != vc->vc_font.height || 265 ops->cursor_reset) { 266 ops->cursor_state.image.height = vc->vc_font.width; 267 ops->cursor_state.image.width = vc->vc_font.height; 268 cursor.set |= FB_CUR_SETSIZE; 269 } 270 271 dx = vxres - ((y * vc->vc_font.height) + vc->vc_font.height); 272 dy = vc->vc_x * vc->vc_font.width; 273 274 if (ops->cursor_state.image.dx != dx || 275 ops->cursor_state.image.dy != dy || 276 ops->cursor_reset) { 277 ops->cursor_state.image.dx = dx; 278 ops->cursor_state.image.dy = dy; 279 cursor.set |= FB_CUR_SETPOS; 280 } 281 282 if (ops->cursor_state.hot.x || ops->cursor_state.hot.y || 283 ops->cursor_reset) { 284 ops->cursor_state.hot.x = cursor.hot.y = 0; 285 cursor.set |= FB_CUR_SETHOT; 286 } 287 288 if (cursor.set & FB_CUR_SETSIZE || 289 vc->vc_cursor_type != ops->p->cursor_shape || 290 ops->cursor_state.mask == NULL || 291 ops->cursor_reset) { 292 char *tmp, *mask = kmalloc(w*vc->vc_font.width, GFP_ATOMIC); 293 int cur_height, size, i = 0; 294 int width = (vc->vc_font.width + 7)/8; 295 296 if (!mask) 297 return; 298 299 tmp = kmalloc(width * vc->vc_font.height, GFP_ATOMIC); 300 301 if (!tmp) { 302 kfree(mask); 303 return; 304 } 305 306 kfree(ops->cursor_state.mask); 307 ops->cursor_state.mask = mask; 308 309 ops->p->cursor_shape = vc->vc_cursor_type; 310 cursor.set |= FB_CUR_SETSHAPE; 311 312 switch (ops->p->cursor_shape & CUR_HWMASK) { 313 case CUR_NONE: 314 cur_height = 0; 315 break; 316 case CUR_UNDERLINE: 317 cur_height = (vc->vc_font.height < 10) ? 1 : 2; 318 break; 319 case CUR_LOWER_THIRD: 320 cur_height = vc->vc_font.height/3; 321 break; 322 case CUR_LOWER_HALF: 323 cur_height = vc->vc_font.height >> 1; 324 break; 325 case CUR_TWO_THIRDS: 326 cur_height = (vc->vc_font.height << 1)/3; 327 break; 328 case CUR_BLOCK: 329 default: 330 cur_height = vc->vc_font.height; 331 break; 332 } 333 334 size = (vc->vc_font.height - cur_height) * width; 335 while (size--) 336 tmp[i++] = 0; 337 size = cur_height * width; 338 while (size--) 339 tmp[i++] = 0xff; 340 memset(mask, 0, w * vc->vc_font.width); 341 rotate_cw(tmp, mask, vc->vc_font.width, vc->vc_font.height); 342 kfree(tmp); 343 } 344 345 switch (mode) { 346 case CM_ERASE: 347 ops->cursor_state.enable = 0; 348 break; 349 case CM_DRAW: 350 case CM_MOVE: 351 default: 352 ops->cursor_state.enable = (use_sw) ? 0 : 1; 353 break; 354 } 355 356 cursor.image.data = src; 357 cursor.image.fg_color = ops->cursor_state.image.fg_color; 358 cursor.image.bg_color = ops->cursor_state.image.bg_color; 359 cursor.image.dx = ops->cursor_state.image.dx; 360 cursor.image.dy = ops->cursor_state.image.dy; 361 cursor.image.height = ops->cursor_state.image.height; 362 cursor.image.width = ops->cursor_state.image.width; 363 cursor.hot.x = ops->cursor_state.hot.x; 364 cursor.hot.y = ops->cursor_state.hot.y; 365 cursor.mask = ops->cursor_state.mask; 366 cursor.enable = ops->cursor_state.enable; 367 cursor.image.depth = 1; 368 cursor.rop = ROP_XOR; 369 370 if (info->fbops->fb_cursor) 371 err = info->fbops->fb_cursor(info, &cursor); 372 373 if (err) 374 soft_cursor(info, &cursor); 375 376 ops->cursor_reset = 0; 377} 378 379static int cw_update_start(struct fb_info *info) 380{ 381 struct fbcon_ops *ops = info->fbcon_par; 382 u32 vxres = GETVXRES(ops->p->scrollmode, info); 383 u32 xoffset; 384 int err; 385 386 xoffset = vxres - (info->var.xres + ops->var.yoffset); 387 ops->var.yoffset = ops->var.xoffset; 388 ops->var.xoffset = xoffset; 389 err = fb_pan_display(info, &ops->var); 390 ops->var.xoffset = info->var.xoffset; 391 ops->var.yoffset = info->var.yoffset; 392 ops->var.vmode = info->var.vmode; 393 return err; 394} 395 396void fbcon_rotate_cw(struct fbcon_ops *ops) 397{ 398 ops->bmove = cw_bmove; 399 ops->clear = cw_clear; 400 ops->putcs = cw_putcs; 401 ops->clear_margins = cw_clear_margins; 402 ops->cursor = cw_cursor; 403 ops->update_start = cw_update_start; 404} 405EXPORT_SYMBOL(fbcon_rotate_cw); 406 407MODULE_AUTHOR("Antonino Daplas <adaplas@pol.net>"); 408MODULE_DESCRIPTION("Console Rotation (90 degrees) Support"); 409MODULE_LICENSE("GPL"); 410