第18章LCD设备驱动之帧缓冲设备驱动的读写、mmap和ioctl函数

最新推荐文章于 2024-07-17 15:44:59 发布

静能生悟

最新推荐文章于 2024-07-17 15:44:59 发布

阅读量751

点赞数

CC 4.0 BY-SA版权

分类专栏： Linux驱动开发

本文链接：https://blog.youkuaiyun.com/xiezhi123456/article/details/80756501

18.8 帧缓冲设备驱动的读写、mmap和ioctl函数

虽然帧缓冲设备的 file_operations 中的成员函数，即文件操作函数由内核在 fbmem.c 文件中实现，一般不再需要驱动工程师修改，但分析这些函数对于巩固字符设备驱动的知识以及加深对帧缓冲设备驱动的理解是大有好处的。

代码清单 18.12所示为帧缓冲设备驱动的文件操作读写函数的源代码。

代码清单 18.12 帧缓冲设备驱动的读写函数

static ssize_t
fb_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
{
unsigned long p = *ppos;
struct fb_info *info = file_fb_info(file);
u8 *buffer, *dst;
u8 __iomem *src;
int c, 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 = (u8 __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;
fb_memcpy_fromfb(dst, src, c);
dst += c;
src += c;

if (copy_to_user(buf, buffer, c)) {
err = -EFAULT;
break;
}
*ppos += c;
buf += c;
cnt += c;
count -= c;
}

kfree(buffer);

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;
struct fb_info *info = file_fb_info(file);
u8 *buffer, *src;
u8 __iomem *dst;
int c, 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_write)