2005-04-17 02:20:36 +04:00
/*
* linux / drivers / video / fbmem . c
*
* Copyright ( C ) 1994 Martin Schaller
*
* 2001 - Documented with DocBook
* - Brad Douglas < brad @ neruo . com >
*
* This file is subject to the terms and conditions of the GNU General Public
* License . See the file COPYING in the main directory of this archive
* for more details .
*/
# include <linux/module.h>
2005-11-09 08:39:19 +03:00
# include <linux/compat.h>
2005-04-17 02:20:36 +04:00
# include <linux/types.h>
# include <linux/errno.h>
# include <linux/smp_lock.h>
# include <linux/kernel.h>
# include <linux/major.h>
# include <linux/slab.h>
# include <linux/mm.h>
# include <linux/mman.h>
2006-07-10 15:44:12 +04:00
# include <linux/vt.h>
2005-04-17 02:20:36 +04:00
# include <linux/init.h>
# include <linux/linux_logo.h>
# include <linux/proc_fs.h>
# include <linux/console.h>
# ifdef CONFIG_KMOD
# include <linux/kmod.h>
# endif
# include <linux/err.h>
# include <linux/device.h>
# include <linux/efi.h>
# if defined(__mc68000__) || defined(CONFIG_APUS)
# include <asm/setup.h>
# endif
# include <asm/io.h>
# include <asm/uaccess.h>
# include <asm/page.h>
# include <asm/pgtable.h>
# include <linux/fb.h>
/*
* Frame buffer device initialization and setup routines
*/
# define FBPIXMAPSIZE (1024 * 8)
2006-12-08 13:40:29 +03:00
struct fb_info * registered_fb [ FB_MAX ] __read_mostly ;
int num_registered_fb __read_mostly ;
2005-04-17 02:20:36 +04:00
/*
* Helpers
*/
2005-09-10 00:04:37 +04:00
int fb_get_color_depth ( struct fb_var_screeninfo * var ,
struct fb_fix_screeninfo * fix )
2005-04-17 02:20:36 +04:00
{
2005-09-10 00:04:37 +04:00
int depth = 0 ;
if ( fix - > visual = = FB_VISUAL_MONO01 | |
fix - > visual = = FB_VISUAL_MONO10 )
depth = 1 ;
else {
if ( var - > green . length = = var - > blue . length & &
var - > green . length = = var - > red . length & &
var - > green . offset = = var - > blue . offset & &
var - > green . offset = = var - > red . offset )
depth = var - > green . length ;
else
depth = var - > green . length + var - > red . length +
var - > blue . length ;
}
return depth ;
2005-04-17 02:20:36 +04:00
}
EXPORT_SYMBOL ( fb_get_color_depth ) ;
/*
2005-06-22 04:16:58 +04:00
* Data padding functions .
2005-04-17 02:20:36 +04:00
*/
2005-06-22 04:17:07 +04:00
void fb_pad_aligned_buffer ( u8 * dst , u32 d_pitch , u8 * src , u32 s_pitch , u32 height )
2005-04-17 02:20:36 +04:00
{
2005-09-10 00:10:04 +04:00
__fb_pad_aligned_buffer ( dst , d_pitch , src , s_pitch , height ) ;
2005-04-17 02:20:36 +04:00
}
2005-06-22 04:17:07 +04:00
EXPORT_SYMBOL ( fb_pad_aligned_buffer ) ;
2005-04-17 02:20:36 +04:00
2005-06-22 04:17:07 +04:00
void fb_pad_unaligned_buffer ( u8 * dst , u32 d_pitch , u8 * src , u32 idx , u32 height ,
u32 shift_high , u32 shift_low , u32 mod )
2005-04-17 02:20:36 +04:00
{
u8 mask = ( u8 ) ( 0xfff < < shift_high ) , tmp ;
int i , j ;
for ( i = height ; i - - ; ) {
for ( j = 0 ; j < idx ; j + + ) {
tmp = dst [ j ] ;
tmp & = mask ;
tmp | = * src > > shift_low ;
dst [ j ] = tmp ;
tmp = * src < < shift_high ;
dst [ j + 1 ] = tmp ;
src + + ;
}
tmp = dst [ idx ] ;
tmp & = mask ;
tmp | = * src > > shift_low ;
dst [ idx ] = tmp ;
if ( shift_high < mod ) {
tmp = * src < < shift_high ;
dst [ idx + 1 ] = tmp ;
}
src + + ;
dst + = d_pitch ;
}
}
2005-06-22 04:17:07 +04:00
EXPORT_SYMBOL ( fb_pad_unaligned_buffer ) ;
2005-04-17 02:20:36 +04:00
/*
* we need to lock this section since fb_cursor
* may use fb_imageblit ( )
*/
char * fb_get_buffer_offset ( struct fb_info * info , struct fb_pixmap * buf , u32 size )
{
u32 align = buf - > buf_align - 1 , offset ;
char * addr = buf - > addr ;
/* If IO mapped, we need to sync before access, no sharing of
* the pixmap is done
*/
if ( buf - > flags & FB_PIXMAP_IO ) {
if ( info - > fbops - > fb_sync & & ( buf - > flags & FB_PIXMAP_SYNC ) )
info - > fbops - > fb_sync ( info ) ;
return addr ;
}
/* See if we fit in the remaining pixmap space */
offset = buf - > offset + align ;
offset & = ~ align ;
if ( offset + size > buf - > size ) {
/* We do not fit. In order to be able to re-use the buffer,
* we must ensure no asynchronous DMA ' ing or whatever operation
* is in progress , we sync for that .
*/
if ( info - > fbops - > fb_sync & & ( buf - > flags & FB_PIXMAP_SYNC ) )
info - > fbops - > fb_sync ( info ) ;
offset = 0 ;
}
buf - > offset = offset + size ;
addr + = offset ;
return addr ;
}
# ifdef CONFIG_LOGO
static inline unsigned safe_shift ( unsigned d , int n )
{
return n < 0 ? d > > - n : d < < n ;
}
static void fb_set_logocmap ( struct fb_info * info ,
const struct linux_logo * logo )
{
struct fb_cmap palette_cmap ;
u16 palette_green [ 16 ] ;
u16 palette_blue [ 16 ] ;
u16 palette_red [ 16 ] ;
int i , j , n ;
const unsigned char * clut = logo - > clut ;
palette_cmap . start = 0 ;
palette_cmap . len = 16 ;
palette_cmap . red = palette_red ;
palette_cmap . green = palette_green ;
palette_cmap . blue = palette_blue ;
palette_cmap . transp = NULL ;
for ( i = 0 ; i < logo - > clutsize ; i + = n ) {
n = logo - > clutsize - i ;
/* palette_cmap provides space for only 16 colors at once */
if ( n > 16 )
n = 16 ;
palette_cmap . start = 32 + i ;
palette_cmap . len = n ;
for ( j = 0 ; j < n ; + + j ) {
palette_cmap . red [ j ] = clut [ 0 ] < < 8 | clut [ 0 ] ;
palette_cmap . green [ j ] = clut [ 1 ] < < 8 | clut [ 1 ] ;
palette_cmap . blue [ j ] = clut [ 2 ] < < 8 | clut [ 2 ] ;
clut + = 3 ;
}
fb_set_cmap ( & palette_cmap , info ) ;
}
}
static void fb_set_logo_truepalette ( struct fb_info * info ,
const struct linux_logo * logo ,
u32 * palette )
{
2006-12-08 13:40:29 +03:00
static const unsigned char mask [ ] = { 0 , 0x80 , 0xc0 , 0xe0 , 0xf0 , 0xf8 , 0xfc , 0xfe , 0xff } ;
2005-04-17 02:20:36 +04:00
unsigned char redmask , greenmask , bluemask ;
int redshift , greenshift , blueshift ;
int i ;
const unsigned char * clut = logo - > clut ;
/*
* We have to create a temporary palette since console palette is only
* 16 colors long .
*/
/* Bug: Doesn't obey msb_right ... (who needs that?) */
redmask = mask [ info - > var . red . length < 8 ? info - > var . red . length : 8 ] ;
greenmask = mask [ info - > var . green . length < 8 ? info - > var . green . length : 8 ] ;
bluemask = mask [ info - > var . blue . length < 8 ? info - > var . blue . length : 8 ] ;
redshift = info - > var . red . offset - ( 8 - info - > var . red . length ) ;
greenshift = info - > var . green . offset - ( 8 - info - > var . green . length ) ;
blueshift = info - > var . blue . offset - ( 8 - info - > var . blue . length ) ;
for ( i = 0 ; i < logo - > clutsize ; i + + ) {
palette [ i + 32 ] = ( safe_shift ( ( clut [ 0 ] & redmask ) , redshift ) |
safe_shift ( ( clut [ 1 ] & greenmask ) , greenshift ) |
safe_shift ( ( clut [ 2 ] & bluemask ) , blueshift ) ) ;
clut + = 3 ;
}
}
static void fb_set_logo_directpalette ( struct fb_info * info ,
const struct linux_logo * logo ,
u32 * palette )
{
int redshift , greenshift , blueshift ;
int i ;
redshift = info - > var . red . offset ;
greenshift = info - > var . green . offset ;
blueshift = info - > var . blue . offset ;
for ( i = 32 ; i < logo - > clutsize ; i + + )
palette [ i ] = i < < redshift | i < < greenshift | i < < blueshift ;
}
static void fb_set_logo ( struct fb_info * info ,
const struct linux_logo * logo , u8 * dst ,
int depth )
{
2005-09-10 00:04:37 +04:00
int i , j , k ;
2005-04-17 02:20:36 +04:00
const u8 * src = logo - > data ;
2005-09-10 00:04:37 +04:00
u8 xor = ( info - > fix . visual = = FB_VISUAL_MONO01 ) ? 0xff : 0 ;
u8 fg = 1 , d ;
2005-04-17 02:20:36 +04:00
2005-09-10 00:04:37 +04:00
if ( fb_get_color_depth ( & info - > var , & info - > fix ) = = 3 )
2005-04-17 02:20:36 +04:00
fg = 7 ;
2005-09-10 00:04:37 +04:00
if ( info - > fix . visual = = FB_VISUAL_MONO01 | |
info - > fix . visual = = FB_VISUAL_MONO10 )
fg = ~ ( ( u8 ) ( 0xfff < < info - > var . green . length ) ) ;
2005-04-17 02:20:36 +04:00
switch ( depth ) {
case 4 :
for ( i = 0 ; i < logo - > height ; i + + )
for ( j = 0 ; j < logo - > width ; src + + ) {
* dst + + = * src > > 4 ;
j + + ;
if ( j < logo - > width ) {
* dst + + = * src & 0x0f ;
j + + ;
}
}
break ;
case 1 :
for ( i = 0 ; i < logo - > height ; i + + ) {
for ( j = 0 ; j < logo - > width ; src + + ) {
d = * src ^ xor ;
for ( k = 7 ; k > = 0 ; k - - ) {
* dst + + = ( ( d > > k ) & 1 ) ? fg : 0 ;
j + + ;
}
}
}
break ;
}
}
/*
* Three ( 3 ) kinds of logo maps exist . linux_logo_clut224 ( > 16 colors ) ,
* linux_logo_vga16 ( 16 colors ) and linux_logo_mono ( 2 colors ) . Depending on
* the visual format and color depth of the framebuffer , the DAC , the
* pseudo_palette , and the logo data will be adjusted accordingly .
*
* Case 1 - linux_logo_clut224 :
* Color exceeds the number of console colors ( 16 ) , thus we set the hardware DAC
* using fb_set_cmap ( ) appropriately . The " needs_cmapreset " flag will be set .
*
* For visuals that require color info from the pseudo_palette , we also construct
* one for temporary use . The " needs_directpalette " or " needs_truepalette " flags
* will be set .
*
* Case 2 - linux_logo_vga16 :
* The number of colors just matches the console colors , thus there is no need
* to set the DAC or the pseudo_palette . However , the bitmap is packed , ie ,
* each byte contains color information for two pixels ( upper and lower nibble ) .
* To be consistent with fb_imageblit ( ) usage , we therefore separate the two
* nibbles into separate bytes . The " depth " flag will be set to 4.
*
* Case 3 - linux_logo_mono :
* This is similar with Case 2. Each byte contains information for 8 pixels .
* We isolate each bit and expand each into a byte . The " depth " flag will
* be set to 1.
*/
static struct logo_data {
int depth ;
int needs_directpalette ;
int needs_truepalette ;
int needs_cmapreset ;
const struct linux_logo * logo ;
2006-12-08 13:40:29 +03:00
} fb_logo __read_mostly ;
2005-04-17 02:20:36 +04:00
2005-11-09 08:39:10 +03:00
static void fb_rotate_logo_ud ( const u8 * in , u8 * out , u32 width , u32 height )
{
u32 size = width * height , i ;
out + = size - 1 ;
for ( i = size ; i - - ; )
* out - - = * in + + ;
}
static void fb_rotate_logo_cw ( const u8 * in , u8 * out , u32 width , u32 height )
{
2006-06-26 11:26:56 +04:00
int i , j , h = height - 1 ;
2005-11-09 08:39:10 +03:00
for ( i = 0 ; i < height ; i + + )
for ( j = 0 ; j < width ; j + + )
2006-06-26 11:26:56 +04:00
out [ height * j + h - i ] = * in + + ;
2005-11-09 08:39:10 +03:00
}
static void fb_rotate_logo_ccw ( const u8 * in , u8 * out , u32 width , u32 height )
{
int i , j , w = width - 1 ;
for ( i = 0 ; i < height ; i + + )
for ( j = 0 ; j < width ; j + + )
out [ height * ( w - j ) + i ] = * in + + ;
}
static void fb_rotate_logo ( struct fb_info * info , u8 * dst ,
struct fb_image * image , int rotate )
{
u32 tmp ;
if ( rotate = = FB_ROTATE_UD ) {
fb_rotate_logo_ud ( image - > data , dst , image - > width ,
image - > height ) ;
2007-05-08 11:37:57 +04:00
image - > dx = info - > var . xres - image - > width - image - > dx ;
image - > dy = info - > var . yres - image - > height - image - > dy ;
2005-11-09 08:39:10 +03:00
} else if ( rotate = = FB_ROTATE_CW ) {
fb_rotate_logo_cw ( image - > data , dst , image - > width ,
image - > height ) ;
tmp = image - > width ;
image - > width = image - > height ;
image - > height = tmp ;
2007-05-08 11:37:57 +04:00
tmp = image - > dy ;
image - > dy = image - > dx ;
image - > dx = info - > var . xres - image - > width - tmp ;
2006-06-26 11:26:56 +04:00
} else if ( rotate = = FB_ROTATE_CCW ) {
2005-11-09 08:39:10 +03:00
fb_rotate_logo_ccw ( image - > data , dst , image - > width ,
image - > height ) ;
2006-06-26 11:26:56 +04:00
tmp = image - > width ;
image - > width = image - > height ;
image - > height = tmp ;
2007-05-08 11:37:57 +04:00
tmp = image - > dx ;
image - > dx = image - > dy ;
image - > dy = info - > var . yres - image - > height - tmp ;
2005-11-09 08:39:10 +03:00
}
image - > data = dst ;
}
static void fb_do_show_logo ( struct fb_info * info , struct fb_image * image ,
2007-05-08 11:37:56 +04:00
int rotate , unsigned int num )
2005-11-09 08:39:10 +03:00
{
2007-05-08 11:37:56 +04:00
unsigned int x ;
2005-11-09 08:39:10 +03:00
if ( rotate = = FB_ROTATE_UR ) {
2007-05-08 11:37:56 +04:00
for ( x = 0 ;
x < num & & image - > dx + image - > width < = info - > var . xres ;
x + + ) {
2005-11-09 08:39:10 +03:00
info - > fbops - > fb_imageblit ( info , image ) ;
2007-05-08 11:37:56 +04:00
image - > dx + = image - > width + 8 ;
2005-11-09 08:39:10 +03:00
}
} else if ( rotate = = FB_ROTATE_UD ) {
2007-05-08 11:37:56 +04:00
for ( x = 0 ; x < num & & image - > dx > = 0 ; x + + ) {
2005-11-09 08:39:10 +03:00
info - > fbops - > fb_imageblit ( info , image ) ;
2007-05-08 11:37:56 +04:00
image - > dx - = image - > width + 8 ;
2005-11-09 08:39:10 +03:00
}
} else if ( rotate = = FB_ROTATE_CW ) {
2007-05-08 11:37:56 +04:00
for ( x = 0 ;
x < num & & image - > dy + image - > height < = info - > var . yres ;
x + + ) {
2005-11-09 08:39:10 +03:00
info - > fbops - > fb_imageblit ( info , image ) ;
2007-05-08 11:37:56 +04:00
image - > dy + = image - > height + 8 ;
2005-11-09 08:39:10 +03:00
}
} else if ( rotate = = FB_ROTATE_CCW ) {
2007-05-08 11:37:56 +04:00
for ( x = 0 ; x < num & & image - > dy > = 0 ; x + + ) {
2005-11-09 08:39:10 +03:00
info - > fbops - > fb_imageblit ( info , image ) ;
2007-05-08 11:37:56 +04:00
image - > dy - = image - > height + 8 ;
2005-11-09 08:39:10 +03:00
}
}
}
int fb_prepare_logo ( struct fb_info * info , int rotate )
2005-04-17 02:20:36 +04:00
{
2005-09-10 00:04:37 +04:00
int depth = fb_get_color_depth ( & info - > var , & info - > fix ) ;
2005-11-09 08:39:10 +03:00
int yres ;
2005-04-17 02:20:36 +04:00
memset ( & fb_logo , 0 , sizeof ( struct logo_data ) ) ;
2007-05-08 11:38:14 +04:00
if ( info - > flags & FBINFO_MISC_TILEBLITTING | |
info - > flags & FBINFO_MODULE )
2005-04-17 02:20:36 +04:00
return 0 ;
if ( info - > fix . visual = = FB_VISUAL_DIRECTCOLOR ) {
depth = info - > var . blue . length ;
if ( info - > var . red . length < depth )
depth = info - > var . red . length ;
if ( info - > var . green . length < depth )
depth = info - > var . green . length ;
}
2006-06-26 11:26:36 +04:00
if ( info - > fix . visual = = FB_VISUAL_STATIC_PSEUDOCOLOR & & depth > 4 ) {
2006-04-11 09:55:49 +04:00
/* assume console colormap */
depth = 4 ;
}
2005-04-17 02:20:36 +04:00
if ( depth > = 8 ) {
switch ( info - > fix . visual ) {
case FB_VISUAL_TRUECOLOR :
fb_logo . needs_truepalette = 1 ;
break ;
case FB_VISUAL_DIRECTCOLOR :
fb_logo . needs_directpalette = 1 ;
fb_logo . needs_cmapreset = 1 ;
break ;
case FB_VISUAL_PSEUDOCOLOR :
fb_logo . needs_cmapreset = 1 ;
break ;
}
}
/* Return if no suitable logo was found */
fb_logo . logo = fb_find_logo ( depth ) ;
2005-11-24 18:53:36 +03:00
if ( ! fb_logo . logo ) {
return 0 ;
}
2005-04-17 02:20:36 +04:00
2005-11-09 08:39:10 +03:00
if ( rotate = = FB_ROTATE_UR | | rotate = = FB_ROTATE_UD )
yres = info - > var . yres ;
else
yres = info - > var . xres ;
2005-11-24 18:53:36 +03:00
if ( fb_logo . logo - > height > yres ) {
2005-04-17 02:20:36 +04:00
fb_logo . logo = NULL ;
return 0 ;
}
2005-11-09 08:39:10 +03:00
2005-04-17 02:20:36 +04:00
/* What depth we asked for might be different from what we get */
if ( fb_logo . logo - > type = = LINUX_LOGO_CLUT224 )
fb_logo . depth = 8 ;
else if ( fb_logo . logo - > type = = LINUX_LOGO_VGA16 )
fb_logo . depth = 4 ;
else
fb_logo . depth = 1 ;
return fb_logo . logo - > height ;
}
2005-11-09 08:39:10 +03:00
int fb_show_logo ( struct fb_info * info , int rotate )
2005-04-17 02:20:36 +04:00
{
u32 * palette = NULL , * saved_pseudo_palette = NULL ;
2005-11-09 08:39:10 +03:00
unsigned char * logo_new = NULL , * logo_rotate = NULL ;
2005-04-17 02:20:36 +04:00
struct fb_image image ;
/* Return if the frame buffer is not mapped or suspended */
2007-05-08 11:38:14 +04:00
if ( fb_logo . logo = = NULL | | info - > state ! = FBINFO_STATE_RUNNING | |
info - > flags & FBINFO_MODULE )
2005-04-17 02:20:36 +04:00
return 0 ;
image . depth = 8 ;
image . data = fb_logo . logo - > data ;
if ( fb_logo . needs_cmapreset )
fb_set_logocmap ( info , fb_logo . logo ) ;
if ( fb_logo . needs_truepalette | |
fb_logo . needs_directpalette ) {
palette = kmalloc ( 256 * 4 , GFP_KERNEL ) ;
if ( palette = = NULL )
return 0 ;
if ( fb_logo . needs_truepalette )
fb_set_logo_truepalette ( info , fb_logo . logo , palette ) ;
else
fb_set_logo_directpalette ( info , fb_logo . logo , palette ) ;
saved_pseudo_palette = info - > pseudo_palette ;
info - > pseudo_palette = palette ;
}
if ( fb_logo . depth < = 4 ) {
logo_new = kmalloc ( fb_logo . logo - > width * fb_logo . logo - > height ,
GFP_KERNEL ) ;
if ( logo_new = = NULL ) {
kfree ( palette ) ;
if ( saved_pseudo_palette )
info - > pseudo_palette = saved_pseudo_palette ;
return 0 ;
}
image . data = logo_new ;
fb_set_logo ( info , fb_logo . logo , logo_new , fb_logo . depth ) ;
}
2005-11-09 08:39:10 +03:00
image . dx = 0 ;
image . dy = 0 ;
2005-04-17 02:20:36 +04:00
image . width = fb_logo . logo - > width ;
image . height = fb_logo . logo - > height ;
2005-11-09 08:39:10 +03:00
if ( rotate ) {
logo_rotate = kmalloc ( fb_logo . logo - > width *
fb_logo . logo - > height , GFP_KERNEL ) ;
if ( logo_rotate )
fb_rotate_logo ( info , logo_rotate , & image , rotate ) ;
2005-04-17 02:20:36 +04:00
}
2005-11-09 08:39:10 +03:00
2007-05-08 11:37:56 +04:00
fb_do_show_logo ( info , & image , rotate , num_online_cpus ( ) ) ;
2005-11-09 08:39:10 +03:00
2005-04-17 02:20:36 +04:00
kfree ( palette ) ;
if ( saved_pseudo_palette ! = NULL )
info - > pseudo_palette = saved_pseudo_palette ;
kfree ( logo_new ) ;
2005-11-09 08:39:10 +03:00
kfree ( logo_rotate ) ;
2005-04-17 02:20:36 +04:00
return fb_logo . logo - > height ;
}
# else
2005-11-09 08:39:10 +03:00
int fb_prepare_logo ( struct fb_info * info , int rotate ) { return 0 ; }
int fb_show_logo ( struct fb_info * info , int rotate ) { return 0 ; }
2005-04-17 02:20:36 +04:00
# endif /* CONFIG_LOGO */
static int fbmem_read_proc ( char * buf , char * * start , off_t offset ,
int len , int * eof , void * private )
{
struct fb_info * * fi ;
int clen ;
clen = 0 ;
2006-10-03 12:15:11 +04:00
for ( fi = registered_fb ; fi < & registered_fb [ FB_MAX ] & & clen < 4000 ;
fi + + )
2005-04-17 02:20:36 +04:00
if ( * fi )
clen + = sprintf ( buf + clen , " %d %s \n " ,
( * fi ) - > node ,
( * fi ) - > fix . id ) ;
* start = buf + offset ;
if ( clen > offset )
clen - = offset ;
else
clen = 0 ;
return clen < len ? clen : len ;
}
static ssize_t
fb_read ( struct file * file , char __user * buf , size_t count , loff_t * ppos )
{
unsigned long p = * ppos ;
2006-12-08 13:37:48 +03:00
struct inode * inode = file - > f_path . dentry - > d_inode ;
2005-04-17 02:20:36 +04:00
int fbidx = iminor ( inode ) ;
struct fb_info * info = registered_fb [ fbidx ] ;
u32 * buffer , * dst ;
u32 __iomem * src ;
int c , i , cnt = 0 , err = 0 ;
unsigned long total_size ;
if ( ! info | | ! info - > screen_base )
return - ENODEV ;
if ( info - > state ! = FBINFO_STATE_RUNNING )
return - EPERM ;
if ( info - > fbops - > fb_read )
2007-05-08 11:39:02 +04:00
return info - > fbops - > fb_read ( info , buf , count , ppos ) ;
2005-04-17 02:20:36 +04:00
total_size = info - > screen_size ;
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
if ( total_size = = 0 )
total_size = info - > fix . smem_len ;
if ( p > = total_size )
2006-01-10 07:53:37 +03:00
return 0 ;
2005-04-17 02:20:36 +04:00
if ( count > = total_size )
2006-01-10 07:53:37 +03:00
count = total_size ;
2005-04-17 02:20:36 +04:00
if ( count + p > total_size )
count = total_size - p ;
buffer = kmalloc ( ( count > PAGE_SIZE ) ? PAGE_SIZE : count ,
GFP_KERNEL ) ;
if ( ! buffer )
return - ENOMEM ;
src = ( u32 __iomem * ) ( info - > screen_base + p ) ;
if ( info - > fbops - > fb_sync )
info - > fbops - > fb_sync ( info ) ;
while ( count ) {
c = ( count > PAGE_SIZE ) ? PAGE_SIZE : count ;
dst = buffer ;
for ( i = c > > 2 ; i - - ; )
* dst + + = fb_readl ( src + + ) ;
if ( c & 3 ) {
u8 * dst8 = ( u8 * ) dst ;
u8 __iomem * src8 = ( u8 __iomem * ) src ;
for ( i = c & 3 ; i - - ; )
* dst8 + + = fb_readb ( src8 + + ) ;
src = ( u32 __iomem * ) src8 ;
}
if ( copy_to_user ( buf , buffer , c ) ) {
err = - EFAULT ;
break ;
}
* ppos + = c ;
buf + = c ;
cnt + = c ;
count - = c ;
}
kfree ( buffer ) ;
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
return ( err ) ? err : cnt ;
}
static ssize_t
fb_write ( struct file * file , const char __user * buf , size_t count , loff_t * ppos )
{
unsigned long p = * ppos ;
2006-12-08 13:37:48 +03:00
struct inode * inode = file - > f_path . dentry - > d_inode ;
2005-04-17 02:20:36 +04:00
int fbidx = iminor ( inode ) ;
struct fb_info * info = registered_fb [ fbidx ] ;
u32 * buffer , * src ;
u32 __iomem * dst ;
2006-01-10 07:53:37 +03:00
int c , i , cnt = 0 , err = 0 ;
2005-04-17 02:20:36 +04:00
unsigned long total_size ;
if ( ! info | | ! info - > screen_base )
return - ENODEV ;
if ( info - > state ! = FBINFO_STATE_RUNNING )
return - EPERM ;
if ( info - > fbops - > fb_write )
2007-05-08 11:39:02 +04:00
return info - > fbops - > fb_write ( info , buf , count , ppos ) ;
2005-04-17 02:20:36 +04:00
total_size = info - > screen_size ;
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
if ( total_size = = 0 )
total_size = info - > fix . smem_len ;
if ( p > total_size )
2006-04-19 09:22:12 +04:00
return - EFBIG ;
2006-01-10 07:53:37 +03:00
2006-04-19 09:22:12 +04:00
if ( count > total_size ) {
err = - EFBIG ;
2006-01-10 07:53:37 +03:00
count = total_size ;
2006-04-19 09:22:12 +04:00
}
if ( count + p > total_size ) {
if ( ! err )
err = - ENOSPC ;
2006-01-10 07:53:37 +03:00
count = total_size - p ;
2006-04-19 09:22:12 +04:00
}
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
buffer = kmalloc ( ( count > PAGE_SIZE ) ? PAGE_SIZE : count ,
GFP_KERNEL ) ;
if ( ! buffer )
return - ENOMEM ;
dst = ( u32 __iomem * ) ( info - > screen_base + p ) ;
if ( info - > fbops - > fb_sync )
info - > fbops - > fb_sync ( info ) ;
while ( count ) {
c = ( count > PAGE_SIZE ) ? PAGE_SIZE : count ;
src = buffer ;
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
if ( copy_from_user ( src , buf , c ) ) {
err = - EFAULT ;
break ;
}
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
for ( i = c > > 2 ; i - - ; )
fb_writel ( * src + + , dst + + ) ;
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
if ( c & 3 ) {
u8 * src8 = ( u8 * ) src ;
u8 __iomem * dst8 = ( u8 __iomem * ) dst ;
for ( i = c & 3 ; i - - ; )
fb_writeb ( * src8 + + , dst8 + + ) ;
dst = ( u32 __iomem * ) dst8 ;
}
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
* ppos + = c ;
buf + = c ;
cnt + = c ;
count - = c ;
}
2006-01-10 07:53:37 +03:00
2005-04-17 02:20:36 +04:00
kfree ( buffer ) ;
2006-04-19 09:22:12 +04:00
return ( cnt ) ? cnt : err ;
2005-04-17 02:20:36 +04:00
}
# ifdef CONFIG_KMOD
static void try_to_load ( int fb )
{
request_module ( " fb%d " , fb ) ;
}
# endif /* CONFIG_KMOD */
int
fb_pan_display ( struct fb_info * info , struct fb_var_screeninfo * var )
{
2005-12-13 09:17:17 +03:00
struct fb_fix_screeninfo * fix = & info - > fix ;
2005-04-17 02:20:36 +04:00
int xoffset = var - > xoffset ;
int yoffset = var - > yoffset ;
2005-12-13 09:17:17 +03:00
int err = 0 , yres = info - > var . yres ;
if ( var - > yoffset > 0 ) {
if ( var - > vmode & FB_VMODE_YWRAP ) {
if ( ! fix - > ywrapstep | | ( var - > yoffset % fix - > ywrapstep ) )
err = - EINVAL ;
else
yres = 0 ;
} else if ( ! fix - > ypanstep | | ( var - > yoffset % fix - > ypanstep ) )
err = - EINVAL ;
}
if ( var - > xoffset > 0 & & ( ! fix - > xpanstep | |
( var - > xoffset % fix - > xpanstep ) ) )
err = - EINVAL ;
if ( err | | ! info - > fbops - > fb_pan_display | | xoffset < 0 | |
yoffset < 0 | | var - > yoffset + yres > info - > var . yres_virtual | |
var - > xoffset + info - > var . xres > info - > var . xres_virtual )
return - EINVAL ;
2005-04-17 02:20:36 +04:00
if ( ( err = info - > fbops - > fb_pan_display ( var , info ) ) )
return err ;
info - > var . xoffset = var - > xoffset ;
info - > var . yoffset = var - > yoffset ;
if ( var - > vmode & FB_VMODE_YWRAP )
info - > var . vmode | = FB_VMODE_YWRAP ;
else
info - > var . vmode & = ~ FB_VMODE_YWRAP ;
return 0 ;
}
2007-05-08 11:39:37 +04:00
static int fb_check_caps ( struct fb_info * info , struct fb_var_screeninfo * var ,
u32 activate )
{
struct fb_event event ;
struct fb_blit_caps caps , fbcaps ;
int err = 0 ;
memset ( & caps , 0 , sizeof ( caps ) ) ;
memset ( & fbcaps , 0 , sizeof ( fbcaps ) ) ;
caps . flags = ( activate & FB_ACTIVATE_ALL ) ? 1 : 0 ;
event . info = info ;
event . data = & caps ;
fb_notifier_call_chain ( FB_EVENT_GET_REQ , & event ) ;
info - > fbops - > fb_get_caps ( info , & fbcaps , var ) ;
if ( ( ( fbcaps . x ^ caps . x ) & caps . x ) | |
( ( fbcaps . y ^ caps . y ) & caps . y ) | |
( fbcaps . len < caps . len ) )
err = - EINVAL ;
return err ;
}
2005-04-17 02:20:36 +04:00
int
fb_set_var ( struct fb_info * info , struct fb_var_screeninfo * var )
{
2007-05-08 11:39:52 +04:00
int flags = info - > flags ;
int ret = 0 ;
2005-04-17 02:20:36 +04:00
if ( var - > activate & FB_ACTIVATE_INV_MODE ) {
struct fb_videomode mode1 , mode2 ;
fb_var_to_videomode ( & mode1 , var ) ;
fb_var_to_videomode ( & mode2 , & info - > var ) ;
/* make sure we don't delete the videomode of current var */
ret = fb_mode_is_equal ( & mode1 , & mode2 ) ;
if ( ! ret ) {
struct fb_event event ;
event . info = info ;
event . data = & mode1 ;
2006-07-30 14:04:17 +04:00
ret = fb_notifier_call_chain ( FB_EVENT_MODE_DELETE , & event ) ;
2005-04-17 02:20:36 +04:00
}
if ( ! ret )
fb_delete_videomode ( & mode1 , & info - > modelist ) ;
2007-05-08 11:39:52 +04:00
ret = ( ret ) ? - EINVAL : 0 ;
goto done ;
2005-04-17 02:20:36 +04:00
}
if ( ( var - > activate & FB_ACTIVATE_FORCE ) | |
memcmp ( & info - > var , var , sizeof ( struct fb_var_screeninfo ) ) ) {
2007-05-08 11:39:22 +04:00
u32 activate = var - > activate ;
2005-04-17 02:20:36 +04:00
if ( ! info - > fbops - > fb_check_var ) {
* var = info - > var ;
2007-05-08 11:39:52 +04:00
goto done ;
2005-04-17 02:20:36 +04:00
}
2007-05-08 11:39:52 +04:00
ret = info - > fbops - > fb_check_var ( var , info ) ;
if ( ret )
goto done ;
2005-04-17 02:20:36 +04:00
if ( ( var - > activate & FB_ACTIVATE_MASK ) = = FB_ACTIVATE_NOW ) {
struct fb_videomode mode ;
2007-05-08 11:39:37 +04:00
if ( info - > fbops - > fb_get_caps ) {
2007-05-08 11:39:52 +04:00
ret = fb_check_caps ( info , var , activate ) ;
2007-05-08 11:39:37 +04:00
2007-05-08 11:39:52 +04:00
if ( ret )
2007-05-08 11:39:37 +04:00
goto done ;
}
2005-04-17 02:20:36 +04:00
info - > var = * var ;
2007-05-08 11:39:37 +04:00
2005-04-17 02:20:36 +04:00
if ( info - > fbops - > fb_set_par )
info - > fbops - > fb_set_par ( info ) ;
fb_pan_display ( info , & info - > var ) ;
fb_set_cmap ( & info - > cmap , info ) ;
fb_var_to_videomode ( & mode , & info - > var ) ;
if ( info - > modelist . prev & & info - > modelist . next & &
! list_empty ( & info - > modelist ) )
2007-05-08 11:39:52 +04:00
ret = fb_add_videomode ( & mode , & info - > modelist ) ;
2005-04-17 02:20:36 +04:00
2007-05-08 11:39:52 +04:00
if ( ! ret & & ( flags & FBINFO_MISC_USEREVENT ) ) {
2005-04-17 02:20:36 +04:00
struct fb_event event ;
2007-05-08 11:39:22 +04:00
int evnt = ( activate & FB_ACTIVATE_ALL ) ?
2005-09-10 00:04:29 +04:00
FB_EVENT_MODE_CHANGE_ALL :
FB_EVENT_MODE_CHANGE ;
2005-04-17 02:20:36 +04:00
info - > flags & = ~ FBINFO_MISC_USEREVENT ;
event . info = info ;
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( evnt , & event ) ;
2005-04-17 02:20:36 +04:00
}
}
}
2007-05-08 11:39:37 +04:00
done :
2007-05-08 11:39:52 +04:00
return ret ;
2005-04-17 02:20:36 +04:00
}
int
fb_blank ( struct fb_info * info , int blank )
{
int ret = - EINVAL ;
if ( blank > FB_BLANK_POWERDOWN )
blank = FB_BLANK_POWERDOWN ;
if ( info - > fbops - > fb_blank )
ret = info - > fbops - > fb_blank ( blank , info ) ;
if ( ! ret ) {
struct fb_event event ;
event . info = info ;
event . data = & blank ;
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( FB_EVENT_BLANK , & event ) ;
2005-04-17 02:20:36 +04:00
}
return ret ;
}
static int
fb_ioctl ( struct inode * inode , struct file * file , unsigned int cmd ,
unsigned long arg )
{
int fbidx = iminor ( inode ) ;
struct fb_info * info = registered_fb [ fbidx ] ;
struct fb_ops * fb = info - > fbops ;
struct fb_var_screeninfo var ;
struct fb_fix_screeninfo fix ;
struct fb_con2fbmap con2fb ;
struct fb_cmap_user cmap ;
struct fb_event event ;
void __user * argp = ( void __user * ) arg ;
int i ;
if ( ! fb )
return - ENODEV ;
switch ( cmd ) {
case FBIOGET_VSCREENINFO :
return copy_to_user ( argp , & info - > var ,
sizeof ( var ) ) ? - EFAULT : 0 ;
case FBIOPUT_VSCREENINFO :
if ( copy_from_user ( & var , argp , sizeof ( var ) ) )
return - EFAULT ;
acquire_console_sem ( ) ;
info - > flags | = FBINFO_MISC_USEREVENT ;
i = fb_set_var ( info , & var ) ;
info - > flags & = ~ FBINFO_MISC_USEREVENT ;
release_console_sem ( ) ;
if ( i ) return i ;
if ( copy_to_user ( argp , & var , sizeof ( var ) ) )
return - EFAULT ;
return 0 ;
case FBIOGET_FSCREENINFO :
return copy_to_user ( argp , & info - > fix ,
sizeof ( fix ) ) ? - EFAULT : 0 ;
case FBIOPUTCMAP :
if ( copy_from_user ( & cmap , argp , sizeof ( cmap ) ) )
return - EFAULT ;
return ( fb_set_user_cmap ( & cmap , info ) ) ;
case FBIOGETCMAP :
if ( copy_from_user ( & cmap , argp , sizeof ( cmap ) ) )
return - EFAULT ;
return fb_cmap_to_user ( & info - > cmap , & cmap ) ;
case FBIOPAN_DISPLAY :
if ( copy_from_user ( & var , argp , sizeof ( var ) ) )
return - EFAULT ;
acquire_console_sem ( ) ;
i = fb_pan_display ( info , & var ) ;
release_console_sem ( ) ;
if ( i )
return i ;
if ( copy_to_user ( argp , & var , sizeof ( var ) ) )
return - EFAULT ;
return 0 ;
case FBIO_CURSOR :
return - EINVAL ;
case FBIOGET_CON2FBMAP :
if ( copy_from_user ( & con2fb , argp , sizeof ( con2fb ) ) )
return - EFAULT ;
if ( con2fb . console < 1 | | con2fb . console > MAX_NR_CONSOLES )
return - EINVAL ;
con2fb . framebuffer = - 1 ;
event . info = info ;
event . data = & con2fb ;
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( FB_EVENT_GET_CONSOLE_MAP , & event ) ;
2005-04-17 02:20:36 +04:00
return copy_to_user ( argp , & con2fb ,
sizeof ( con2fb ) ) ? - EFAULT : 0 ;
case FBIOPUT_CON2FBMAP :
if ( copy_from_user ( & con2fb , argp , sizeof ( con2fb ) ) )
return - EFAULT ;
if ( con2fb . console < 0 | | con2fb . console > MAX_NR_CONSOLES )
return - EINVAL ;
if ( con2fb . framebuffer < 0 | | con2fb . framebuffer > = FB_MAX )
return - EINVAL ;
# ifdef CONFIG_KMOD
if ( ! registered_fb [ con2fb . framebuffer ] )
try_to_load ( con2fb . framebuffer ) ;
# endif /* CONFIG_KMOD */
if ( ! registered_fb [ con2fb . framebuffer ] )
return - EINVAL ;
event . info = info ;
event . data = & con2fb ;
2006-07-30 14:04:17 +04:00
return fb_notifier_call_chain ( FB_EVENT_SET_CONSOLE_MAP ,
& event ) ;
2005-04-17 02:20:36 +04:00
case FBIOBLANK :
acquire_console_sem ( ) ;
info - > flags | = FBINFO_MISC_USEREVENT ;
i = fb_blank ( info , arg ) ;
info - > flags & = ~ FBINFO_MISC_USEREVENT ;
release_console_sem ( ) ;
return i ;
default :
if ( fb - > fb_ioctl = = NULL )
return - EINVAL ;
2006-01-15 00:21:25 +03:00
return fb - > fb_ioctl ( info , cmd , arg ) ;
2005-04-17 02:20:36 +04:00
}
}
# ifdef CONFIG_COMPAT
2005-11-09 08:39:19 +03:00
struct fb_fix_screeninfo32 {
char id [ 16 ] ;
compat_caddr_t smem_start ;
u32 smem_len ;
u32 type ;
u32 type_aux ;
u32 visual ;
u16 xpanstep ;
u16 ypanstep ;
u16 ywrapstep ;
u32 line_length ;
compat_caddr_t mmio_start ;
u32 mmio_len ;
u32 accel ;
u16 reserved [ 3 ] ;
} ;
struct fb_cmap32 {
u32 start ;
u32 len ;
compat_caddr_t red ;
compat_caddr_t green ;
compat_caddr_t blue ;
compat_caddr_t transp ;
} ;
static int fb_getput_cmap ( struct inode * inode , struct file * file ,
unsigned int cmd , unsigned long arg )
{
struct fb_cmap_user __user * cmap ;
struct fb_cmap32 __user * cmap32 ;
__u32 data ;
int err ;
cmap = compat_alloc_user_space ( sizeof ( * cmap ) ) ;
cmap32 = compat_ptr ( arg ) ;
if ( copy_in_user ( & cmap - > start , & cmap32 - > start , 2 * sizeof ( __u32 ) ) )
return - EFAULT ;
if ( get_user ( data , & cmap32 - > red ) | |
put_user ( compat_ptr ( data ) , & cmap - > red ) | |
get_user ( data , & cmap32 - > green ) | |
put_user ( compat_ptr ( data ) , & cmap - > green ) | |
get_user ( data , & cmap32 - > blue ) | |
put_user ( compat_ptr ( data ) , & cmap - > blue ) | |
get_user ( data , & cmap32 - > transp ) | |
put_user ( compat_ptr ( data ) , & cmap - > transp ) )
return - EFAULT ;
err = fb_ioctl ( inode , file , cmd , ( unsigned long ) cmap ) ;
if ( ! err ) {
if ( copy_in_user ( & cmap32 - > start ,
& cmap - > start ,
2 * sizeof ( __u32 ) ) )
err = - EFAULT ;
}
return err ;
}
static int do_fscreeninfo_to_user ( struct fb_fix_screeninfo * fix ,
struct fb_fix_screeninfo32 __user * fix32 )
{
__u32 data ;
int err ;
err = copy_to_user ( & fix32 - > id , & fix - > id , sizeof ( fix32 - > id ) ) ;
data = ( __u32 ) ( unsigned long ) fix - > smem_start ;
err | = put_user ( data , & fix32 - > smem_start ) ;
err | = put_user ( fix - > smem_len , & fix32 - > smem_len ) ;
err | = put_user ( fix - > type , & fix32 - > type ) ;
err | = put_user ( fix - > type_aux , & fix32 - > type_aux ) ;
err | = put_user ( fix - > visual , & fix32 - > visual ) ;
err | = put_user ( fix - > xpanstep , & fix32 - > xpanstep ) ;
err | = put_user ( fix - > ypanstep , & fix32 - > ypanstep ) ;
err | = put_user ( fix - > ywrapstep , & fix32 - > ywrapstep ) ;
err | = put_user ( fix - > line_length , & fix32 - > line_length ) ;
data = ( __u32 ) ( unsigned long ) fix - > mmio_start ;
err | = put_user ( data , & fix32 - > mmio_start ) ;
err | = put_user ( fix - > mmio_len , & fix32 - > mmio_len ) ;
err | = put_user ( fix - > accel , & fix32 - > accel ) ;
err | = copy_to_user ( fix32 - > reserved , fix - > reserved ,
sizeof ( fix - > reserved ) ) ;
return err ;
}
static int fb_get_fscreeninfo ( struct inode * inode , struct file * file ,
unsigned int cmd , unsigned long arg )
{
mm_segment_t old_fs ;
struct fb_fix_screeninfo fix ;
struct fb_fix_screeninfo32 __user * fix32 ;
int err ;
fix32 = compat_ptr ( arg ) ;
old_fs = get_fs ( ) ;
set_fs ( KERNEL_DS ) ;
err = fb_ioctl ( inode , file , cmd , ( unsigned long ) & fix ) ;
set_fs ( old_fs ) ;
if ( ! err )
err = do_fscreeninfo_to_user ( & fix , fix32 ) ;
return err ;
}
2005-04-17 02:20:36 +04:00
static long
fb_compat_ioctl ( struct file * file , unsigned int cmd , unsigned long arg )
{
2006-12-08 13:37:48 +03:00
struct inode * inode = file - > f_path . dentry - > d_inode ;
2005-11-09 08:39:19 +03:00
int fbidx = iminor ( inode ) ;
2005-04-17 02:20:36 +04:00
struct fb_info * info = registered_fb [ fbidx ] ;
struct fb_ops * fb = info - > fbops ;
2005-11-09 08:39:19 +03:00
long ret = - ENOIOCTLCMD ;
2005-04-17 02:20:36 +04:00
lock_kernel ( ) ;
2005-11-09 08:39:19 +03:00
switch ( cmd ) {
case FBIOGET_VSCREENINFO :
case FBIOPUT_VSCREENINFO :
case FBIOPAN_DISPLAY :
case FBIOGET_CON2FBMAP :
case FBIOPUT_CON2FBMAP :
arg = ( unsigned long ) compat_ptr ( arg ) ;
case FBIOBLANK :
ret = fb_ioctl ( inode , file , cmd , arg ) ;
break ;
case FBIOGET_FSCREENINFO :
ret = fb_get_fscreeninfo ( inode , file , cmd , arg ) ;
break ;
case FBIOGETCMAP :
case FBIOPUTCMAP :
ret = fb_getput_cmap ( inode , file , cmd , arg ) ;
break ;
default :
if ( fb - > fb_compat_ioctl )
2006-01-15 00:21:25 +03:00
ret = fb - > fb_compat_ioctl ( info , cmd , arg ) ;
2005-11-09 08:39:19 +03:00
break ;
}
2005-04-17 02:20:36 +04:00
unlock_kernel ( ) ;
return ret ;
}
# endif
static int
fb_mmap ( struct file * file , struct vm_area_struct * vma )
{
2006-12-08 13:37:48 +03:00
int fbidx = iminor ( file - > f_path . dentry - > d_inode ) ;
2005-04-17 02:20:36 +04:00
struct fb_info * info = registered_fb [ fbidx ] ;
struct fb_ops * fb = info - > fbops ;
unsigned long off ;
# if !defined(__sparc__) || defined(__sparc_v9__)
unsigned long start ;
u32 len ;
# endif
if ( vma - > vm_pgoff > ( ~ 0UL > > PAGE_SHIFT ) )
return - EINVAL ;
off = vma - > vm_pgoff < < PAGE_SHIFT ;
if ( ! fb )
return - ENODEV ;
if ( fb - > fb_mmap ) {
int res ;
lock_kernel ( ) ;
2006-01-15 00:21:25 +03:00
res = fb - > fb_mmap ( info , vma ) ;
2005-04-17 02:20:36 +04:00
unlock_kernel ( ) ;
return res ;
}
# if defined(__sparc__) && !defined(__sparc_v9__)
/* Should never get here, all fb drivers should have their own
mmap routines */
return - EINVAL ;
# else
/* !sparc32... */
lock_kernel ( ) ;
/* frame buffer memory */
start = info - > fix . smem_start ;
len = PAGE_ALIGN ( ( start & ~ PAGE_MASK ) + info - > fix . smem_len ) ;
if ( off > = len ) {
/* memory mapped io */
off - = len ;
if ( info - > var . accel_flags ) {
unlock_kernel ( ) ;
return - EINVAL ;
}
start = info - > fix . mmio_start ;
len = PAGE_ALIGN ( ( start & ~ PAGE_MASK ) + info - > fix . mmio_len ) ;
}
unlock_kernel ( ) ;
start & = PAGE_MASK ;
if ( ( vma - > vm_end - vma - > vm_start + off ) > len )
return - EINVAL ;
off + = start ;
vma - > vm_pgoff = off > > PAGE_SHIFT ;
/* This is an IO map - tell maydump to skip this VMA */
vma - > vm_flags | = VM_IO | VM_RESERVED ;
# if defined(__mc68000__)
# if defined(CONFIG_SUN3)
pgprot_val ( vma - > vm_page_prot ) | = SUN3_PAGE_NOCACHE ;
# elif defined(CONFIG_MMU)
if ( CPU_IS_020_OR_030 )
pgprot_val ( vma - > vm_page_prot ) | = _PAGE_NOCACHE030 ;
if ( CPU_IS_040_OR_060 ) {
pgprot_val ( vma - > vm_page_prot ) & = _CACHEMASK040 ;
/* Use no-cache mode, serialized */
pgprot_val ( vma - > vm_page_prot ) | = _PAGE_NOCACHE_S ;
}
# endif
# elif defined(__powerpc__)
2005-10-29 04:46:18 +04:00
vma - > vm_page_prot = phys_mem_access_prot ( file , off > > PAGE_SHIFT ,
2005-04-17 02:20:36 +04:00
vma - > vm_end - vma - > vm_start ,
vma - > vm_page_prot ) ;
# elif defined(__alpha__)
/* Caching is off in the I/O space quadrant by design. */
# elif defined(__i386__) || defined(__x86_64__)
if ( boot_cpu_data . x86 > 3 )
pgprot_val ( vma - > vm_page_prot ) | = _PAGE_PCD ;
2006-03-21 13:29:39 +03:00
# elif defined(__mips__) || defined(__sparc_v9__)
2005-04-17 02:20:36 +04:00
vma - > vm_page_prot = pgprot_noncached ( vma - > vm_page_prot ) ;
# elif defined(__hppa__)
pgprot_val ( vma - > vm_page_prot ) | = _PAGE_NO_CACHE ;
# elif defined(__arm__) || defined(__sh__) || defined(__m32r__)
vma - > vm_page_prot = pgprot_writecombine ( vma - > vm_page_prot ) ;
2007-05-09 13:35:33 +04:00
# elif defined(__avr32__)
vma - > vm_page_prot = __pgprot ( ( pgprot_val ( vma - > vm_page_prot )
& ~ _PAGE_CACHABLE )
| ( _PAGE_BUFFER | _PAGE_DIRTY ) ) ;
2005-04-17 02:20:36 +04:00
# elif defined(__ia64__)
if ( efi_range_is_wc ( vma - > vm_start , vma - > vm_end - vma - > vm_start ) )
vma - > vm_page_prot = pgprot_writecombine ( vma - > vm_page_prot ) ;
else
vma - > vm_page_prot = pgprot_noncached ( vma - > vm_page_prot ) ;
# else
# warning What do we have to do here??
# endif
if ( io_remap_pfn_range ( vma , vma - > vm_start , off > > PAGE_SHIFT ,
vma - > vm_end - vma - > vm_start , vma - > vm_page_prot ) )
return - EAGAIN ;
return 0 ;
# endif /* !sparc32 */
}
static int
fb_open ( struct inode * inode , struct file * file )
{
int fbidx = iminor ( inode ) ;
struct fb_info * info ;
int res = 0 ;
if ( fbidx > = FB_MAX )
return - ENODEV ;
# ifdef CONFIG_KMOD
if ( ! ( info = registered_fb [ fbidx ] ) )
try_to_load ( fbidx ) ;
# endif /* CONFIG_KMOD */
if ( ! ( info = registered_fb [ fbidx ] ) )
return - ENODEV ;
if ( ! try_module_get ( info - > fbops - > owner ) )
return - ENODEV ;
2006-01-10 07:53:48 +03:00
file - > private_data = info ;
2005-04-17 02:20:36 +04:00
if ( info - > fbops - > fb_open ) {
res = info - > fbops - > fb_open ( info , 1 ) ;
if ( res )
module_put ( info - > fbops - > owner ) ;
}
return res ;
}
static int
fb_release ( struct inode * inode , struct file * file )
{
2006-01-10 07:53:48 +03:00
struct fb_info * const info = file - > private_data ;
2005-04-17 02:20:36 +04:00
lock_kernel ( ) ;
if ( info - > fbops - > fb_release )
info - > fbops - > fb_release ( info , 1 ) ;
module_put ( info - > fbops - > owner ) ;
unlock_kernel ( ) ;
return 0 ;
}
2006-12-08 13:40:29 +03:00
static const struct file_operations fb_fops = {
2005-04-17 02:20:36 +04:00
. owner = THIS_MODULE ,
. read = fb_read ,
. write = fb_write ,
. ioctl = fb_ioctl ,
# ifdef CONFIG_COMPAT
. compat_ioctl = fb_compat_ioctl ,
# endif
. mmap = fb_mmap ,
. open = fb_open ,
. release = fb_release ,
# ifdef HAVE_ARCH_FB_UNMAPPED_AREA
. get_unmapped_area = get_fb_unmapped_area ,
# endif
2007-05-08 11:37:41 +04:00
# ifdef CONFIG_FB_DEFERRED_IO
. fsync = fb_deferred_io_fsync ,
# endif
2005-04-17 02:20:36 +04:00
} ;
2006-06-26 11:27:05 +04:00
struct class * fb_class ;
EXPORT_SYMBOL ( fb_class ) ;
2005-04-17 02:20:36 +04:00
/**
* register_framebuffer - registers a frame buffer device
* @ fb_info : frame buffer info structure
*
* Registers a frame buffer device @ fb_info .
*
* Returns negative errno on error , or zero for success .
*
*/
int
register_framebuffer ( struct fb_info * fb_info )
{
int i ;
struct fb_event event ;
2005-09-10 00:09:58 +04:00
struct fb_videomode mode ;
2005-04-17 02:20:36 +04:00
if ( num_registered_fb = = FB_MAX )
return - ENXIO ;
num_registered_fb + + ;
for ( i = 0 ; i < FB_MAX ; i + + )
if ( ! registered_fb [ i ] )
break ;
fb_info - > node = i ;
2006-09-14 18:30:59 +04:00
fb_info - > dev = device_create ( fb_class , fb_info - > device ,
MKDEV ( FB_MAJOR , i ) , " fb%d " , i ) ;
if ( IS_ERR ( fb_info - > dev ) ) {
2005-04-17 02:20:36 +04:00
/* Not fatal */
2006-09-14 18:30:59 +04:00
printk ( KERN_WARNING " Unable to create device for framebuffer %d; errno = %ld \n " , i , PTR_ERR ( fb_info - > dev ) ) ;
fb_info - > dev = NULL ;
2005-04-17 02:20:36 +04:00
} else
2006-09-14 18:30:59 +04:00
fb_init_device ( fb_info ) ;
2005-04-17 02:20:36 +04:00
if ( fb_info - > pixmap . addr = = NULL ) {
fb_info - > pixmap . addr = kmalloc ( FBPIXMAPSIZE , GFP_KERNEL ) ;
if ( fb_info - > pixmap . addr ) {
fb_info - > pixmap . size = FBPIXMAPSIZE ;
fb_info - > pixmap . buf_align = 1 ;
fb_info - > pixmap . scan_align = 1 ;
2005-06-22 04:17:08 +04:00
fb_info - > pixmap . access_align = 32 ;
2005-04-17 02:20:36 +04:00
fb_info - > pixmap . flags = FB_PIXMAP_DEFAULT ;
}
}
fb_info - > pixmap . offset = 0 ;
2007-05-08 11:39:09 +04:00
if ( ! fb_info - > pixmap . blit_x )
fb_info - > pixmap . blit_x = ~ ( u32 ) 0 ;
if ( ! fb_info - > pixmap . blit_y )
fb_info - > pixmap . blit_y = ~ ( u32 ) 0 ;
2005-09-10 00:09:58 +04:00
if ( ! fb_info - > modelist . prev | | ! fb_info - > modelist . next )
2005-04-17 02:20:36 +04:00
INIT_LIST_HEAD ( & fb_info - > modelist ) ;
2005-09-10 00:09:58 +04:00
fb_var_to_videomode ( & mode , & fb_info - > var ) ;
fb_add_videomode ( & mode , & fb_info - > modelist ) ;
2005-04-17 02:20:36 +04:00
registered_fb [ i ] = fb_info ;
event . info = fb_info ;
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( FB_EVENT_FB_REGISTERED , & event ) ;
2005-04-17 02:20:36 +04:00
return 0 ;
}
/**
* unregister_framebuffer - releases a frame buffer device
* @ fb_info : frame buffer info structure
*
* Unregisters a frame buffer device @ fb_info .
*
* Returns negative errno on error , or zero for success .
*
*/
int
unregister_framebuffer ( struct fb_info * fb_info )
{
2006-06-26 11:27:09 +04:00
struct fb_event event ;
2005-04-17 02:20:36 +04:00
int i ;
i = fb_info - > node ;
if ( ! registered_fb [ i ] )
return - EINVAL ;
2006-06-26 11:27:09 +04:00
if ( fb_info - > pixmap . addr & &
( fb_info - > pixmap . flags & FB_PIXMAP_DEFAULT ) )
2005-04-17 02:20:36 +04:00
kfree ( fb_info - > pixmap . addr ) ;
fb_destroy_modelist ( & fb_info - > modelist ) ;
registered_fb [ i ] = NULL ;
num_registered_fb - - ;
2006-09-14 18:30:59 +04:00
fb_cleanup_device ( fb_info ) ;
device_destroy ( fb_class , MKDEV ( FB_MAJOR , i ) ) ;
2006-06-26 11:27:09 +04:00
event . info = fb_info ;
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( FB_EVENT_FB_UNREGISTERED , & event ) ;
2005-04-17 02:20:36 +04:00
return 0 ;
}
/**
* fb_set_suspend - low level driver signals suspend
* @ info : framebuffer affected
* @ state : 0 = resuming , ! = 0 = suspending
*
* This is meant to be used by low level drivers to
* signal suspend / resume to the core & clients .
* It must be called with the console semaphore held
*/
void fb_set_suspend ( struct fb_info * info , int state )
{
struct fb_event event ;
event . info = info ;
if ( state ) {
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( FB_EVENT_SUSPEND , & event ) ;
2005-04-17 02:20:36 +04:00
info - > state = FBINFO_STATE_SUSPENDED ;
} else {
info - > state = FBINFO_STATE_RUNNING ;
2006-07-30 14:04:17 +04:00
fb_notifier_call_chain ( FB_EVENT_RESUME , & event ) ;
2005-04-17 02:20:36 +04:00
}
}
/**
* fbmem_init - init frame buffer subsystem
*
* Initialize the frame buffer subsystem .
*
* NOTE : This function is _only_ to be called by drivers / char / mem . c .
*
*/
static int __init
fbmem_init ( void )
{
create_proc_read_entry ( " fb " , 0 , NULL , fbmem_read_proc , NULL ) ;
if ( register_chrdev ( FB_MAJOR , " fb " , & fb_fops ) )
printk ( " unable to get major %d for fb devs \n " , FB_MAJOR ) ;
2005-03-23 21:01:41 +03:00
fb_class = class_create ( THIS_MODULE , " graphics " ) ;
2005-04-17 02:20:36 +04:00
if ( IS_ERR ( fb_class ) ) {
printk ( KERN_WARNING " Unable to create fb class; errno = %ld \n " , PTR_ERR ( fb_class ) ) ;
fb_class = NULL ;
}
return 0 ;
}
# ifdef MODULE
module_init ( fbmem_init ) ;
static void __exit
fbmem_exit ( void )
{
2005-03-23 21:01:41 +03:00
class_destroy ( fb_class ) ;
2005-07-27 22:46:04 +04:00
unregister_chrdev ( FB_MAJOR , " fb " ) ;
2005-04-17 02:20:36 +04:00
}
module_exit ( fbmem_exit ) ;
MODULE_LICENSE ( " GPL " ) ;
MODULE_DESCRIPTION ( " Framebuffer base " ) ;
# else
subsys_initcall ( fbmem_init ) ;
# endif
int fb_new_modelist ( struct fb_info * info )
{
struct fb_event event ;
struct fb_var_screeninfo var = info - > var ;
struct list_head * pos , * n ;
struct fb_modelist * modelist ;
struct fb_videomode * m , mode ;
int err = 1 ;
list_for_each_safe ( pos , n , & info - > modelist ) {
modelist = list_entry ( pos , struct fb_modelist , list ) ;
m = & modelist - > mode ;
fb_videomode_to_var ( & var , m ) ;
var . activate = FB_ACTIVATE_TEST ;
err = fb_set_var ( info , & var ) ;
fb_var_to_videomode ( & mode , & var ) ;
if ( err | | ! fb_mode_is_equal ( m , & mode ) ) {
list_del ( pos ) ;
kfree ( pos ) ;
}
}
err = 1 ;
if ( ! list_empty ( & info - > modelist ) ) {
event . info = info ;
2006-07-30 14:04:17 +04:00
err = fb_notifier_call_chain ( FB_EVENT_NEW_MODELIST , & event ) ;
2005-04-17 02:20:36 +04:00
}
return err ;
}
2006-12-08 13:40:29 +03:00
static char * video_options [ FB_MAX ] __read_mostly ;
static int ofonly __read_mostly ;
2005-04-17 02:20:36 +04:00
2005-05-01 19:59:25 +04:00
extern const char * global_mode_option ;
2005-04-17 02:20:36 +04:00
/**
* fb_get_options - get kernel boot parameters
* @ name : framebuffer name as it would appear in
* the boot parameter line
* ( video = < name > : < options > )
* @ option : the option will be stored here
*
* NOTE : Needed to maintain backwards compatibility
*/
int fb_get_options ( char * name , char * * option )
{
char * opt , * options = NULL ;
int opt_len , retval = 0 ;
int name_len = strlen ( name ) , i ;
if ( name_len & & ofonly & & strncmp ( name , " offb " , 4 ) )
retval = 1 ;
if ( name_len & & ! retval ) {
for ( i = 0 ; i < FB_MAX ; i + + ) {
if ( video_options [ i ] = = NULL )
continue ;
opt_len = strlen ( video_options [ i ] ) ;
if ( ! opt_len )
continue ;
opt = video_options [ i ] ;
if ( ! strncmp ( name , opt , name_len ) & &
opt [ name_len ] = = ' : ' )
options = opt + name_len + 1 ;
}
}
if ( options & & ! strncmp ( options , " off " , 3 ) )
retval = 1 ;
if ( option )
* option = options ;
return retval ;
}
2006-02-12 04:56:08 +03:00
# ifndef MODULE
2005-04-17 02:20:36 +04:00
/**
* video_setup - process command line options
* @ options : string of options
*
* Process command line options for frame buffer subsystem .
*
* NOTE : This function is a __setup and __init function .
* It only stores the options . Drivers have to call
* fb_get_options ( ) as necessary .
*
* Returns zero .
*
*/
2005-05-06 03:16:09 +04:00
static int __init video_setup ( char * options )
2005-04-17 02:20:36 +04:00
{
int i , global = 0 ;
if ( ! options | | ! * options )
global = 1 ;
if ( ! global & & ! strncmp ( options , " ofonly " , 6 ) ) {
ofonly = 1 ;
global = 1 ;
}
if ( ! global & & ! strstr ( options , " fb: " ) ) {
global_mode_option = options ;
global = 1 ;
}
if ( ! global ) {
for ( i = 0 ; i < FB_MAX ; i + + ) {
if ( video_options [ i ] = = NULL ) {
video_options [ i ] = options ;
break ;
}
}
}
2006-03-31 14:30:33 +04:00
return 1 ;
2005-04-17 02:20:36 +04:00
}
__setup ( " video= " , video_setup ) ;
2006-02-12 04:56:08 +03:00
# endif
2005-04-17 02:20:36 +04:00
/*
* Visible symbols for modules
*/
EXPORT_SYMBOL ( register_framebuffer ) ;
EXPORT_SYMBOL ( unregister_framebuffer ) ;
EXPORT_SYMBOL ( num_registered_fb ) ;
EXPORT_SYMBOL ( registered_fb ) ;
EXPORT_SYMBOL ( fb_prepare_logo ) ;
EXPORT_SYMBOL ( fb_show_logo ) ;
EXPORT_SYMBOL ( fb_set_var ) ;
EXPORT_SYMBOL ( fb_blank ) ;
EXPORT_SYMBOL ( fb_pan_display ) ;
EXPORT_SYMBOL ( fb_get_buffer_offset ) ;
EXPORT_SYMBOL ( fb_set_suspend ) ;
EXPORT_SYMBOL ( fb_get_options ) ;
MODULE_LICENSE ( " GPL " ) ;