void FBLinear8::SaveRect(int x1,int y1,int x2,int y2, BitMap& pBuffer) {
assert( x1 >= 0 && x1 < Width() && y1 >=0 && y1 < Height());
assert( x2 >= 0 && x2 < Width() && y2 >=0 && y2 < Height());
assert(x1 <= x2 && y1 <= y2);
__u8* dest = (__u8*)mpBuf + mNextLine * y1 + x1 * 1;
__u8* buf= (__u8*)pBuffer.pBuf;
int height = y2 - y1 + 1;
int width = x2 - x1 + 1;
pBuffer.h = height;
pBuffer.w = width;
pBuffer.BufLen = height * width * 1;
__u8* dest8;
__u8* buf8;
int cnt;
for(; height--; dest += mNextLine) {
dest8 = (__u8*)dest;
buf8 = (__u8*)buf;
for (cnt = width * 1; cnt--;) {
*buf8 = fb_readb(dest8);
dest8++;
buf8++;
}
buf += mNextLine;
}
}
static inline unsigned long copy_to_user16(void *to, const void *from,
unsigned long n)
{
u16 *dst = (u16 *) to;
u16 *src = (u16 *) from;
while (n > 1) {
u16 v = fb_readw(src);
if (__put_user(v, dst))
return n;
src++, dst++;
n -= 2;
}
if (n) {
u8 v = fb_readb(src);
if (__put_user(v, ((u8 *) dst)))
return n;
}
return 0;
}
void FBLinear8::RevRect(int x1,int y1,int x2,int y2) {
assert( x1 >= 0 && x1 < Width() && y1 >=0 && y1 < Height());
assert( x2 >= 0 && x2 < Width() && y2 >=0 && y2 < Height());
assert(x1 <= x2 && y1 <= y2);
__u8* dest = (__u8*)mpBuf + mNextLine * y1 + x1;
int height = y2 - y1 + 1;
int width = x2 - x1 + 1;
int cnt;
__u8* dest8;
__u16* dest16;
__u32 *dest32;
for(; height--; dest += mNextLine) {
dest32 = (__u32*)dest;
for (cnt = width/4; cnt--;) {
fb_writel(fb_readl(dest32) ^ 0x0f0f0f0f, dest32++);
}
if (width & 2) {
dest16 = (__u16*)dest32;
fb_writew(fb_readw(dest16) ^ 0x0f0f, dest16++);
dest32 = (__u32*)dest16;
}
if (width & 1) {
dest8 = (__u8*)dest32;
fb_writeb(fb_readb(dest8) ^ 0x0f, dest8);
}
}
}
static ssize_t
fb_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
{
unsigned long p = *ppos;
struct inode *inode = file->f_path.dentry->d_inode;
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)
return info->fbops->fb_read(info, buf, count, ppos);
total_size = info->screen_size;
if (total_size == 0)
total_size = info->fix.smem_len;
if (p >= total_size)
return 0;
if (count >= total_size)
count = total_size;
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;
}