开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
simple.c
资源名称：LINUX设备驱动程序第二版配套源码.rar　[点击查看]
上传用户：wudi5211
上传日期：2010-01-21
资源大小：607k
文件大小：4k
源码类别：

嵌入式Linux

开发平台：

C/C++

simple.c：源码内容
  1. /*
  2.  * Simple - REALLY simple memory mapping demonstration.
  3.  * $Id: simple.c,v 1.6 2001/03/16 21:04:50 rubini Exp $
  4.  */
  6. #ifndef __KERNEL__
  7. #  define __KERNEL__
  8. #endif
  9. #ifndef MODULE
  10. #  define MODULE
  11. #endif
  13. #include <linux/config.h>
  14. #include <linux/module.h>
  16. #include <linux/kernel.h>   /* printk() */
  17. #include <linux/malloc.h>   /* kmalloc() */
  18. #include <linux/fs.h>       /* everything... */
  19. #include <linux/errno.h>    /* error codes */
  20. #include <linux/types.h>    /* size_t */
  21. #include <asm/page.h>
  23. #include "sysdep.h"
  25. #ifdef LINUX_20
  26. #  error "This module can't run with Linux-2.0"
  27. #endif
  29. static int simple_major = 0;
  30. MODULE_PARM(simple_major, "i");
  31. MODULE_AUTHOR("Jonathan Corbet");
  33. /*
  34.  * Forwards for our methods.
  35.  */
  36. int simple_open (struct inode *inode, struct file *filp);
  37. int simple_release(struct inode *inode, struct file *filp);
  38. int simple_remap_mmap(struct file *filp, struct vm_area_struct *vma);
  39. int simple_nopage_mmap(struct file *filp, struct vm_area_struct *vma);
  42. /*
  43.  * Our various sub-devices.
  44.  */
  45. /* Device 0 uses remap_page_range */
  46. struct file_operations simple_remap_ops = {
  47.     open:    simple_open,
  48.     release: simple_release,
  49.     mmap:    simple_remap_mmap,
  50. };
  52. /* Device 1 uses nopage */
  53. struct file_operations simple_nopage_ops = {
  54.     open:    simple_open,
  55.     release: simple_release,
  56.     mmap:    simple_nopage_mmap,
  57. };
  59. #define MAX_SIMPLE_DEV 2
  61. struct file_operations *simple_fops[MAX_SIMPLE_DEV] = {
  62.     &simple_remap_ops,
  63.     &simple_nopage_ops,
  64. };
  66. /*
  67.  * Open the device; all we have to do here is to up the usage count and
  68.  * set the right fops.
  69.  */
  70. int simple_open (struct inode *inode, struct file *filp)
  71. {
  72.     unsigned int dev = MINOR(inode->i_rdev);
  74.     if (dev >= MAX_SIMPLE_DEV) 
  75.         return -ENODEV;
  76.     filp->f_op = simple_fops[dev];
  77.     MOD_INC_USE_COUNT;
  78.     return 0;
  79. }
  82. /*
  83.  * Closing is even simpler.
  84.  */
  85. int simple_release(struct inode *inode, struct file *filp)
  86. {
  87.     MOD_DEC_USE_COUNT;
  88.     return 0;
  89. }
  93. /*
  94.  * Common VMA ops.
  95.  */
  97. void simple_vma_open(struct vm_area_struct *vma)
  98. { MOD_INC_USE_COUNT; }
  100. void simple_vma_close(struct vm_area_struct *vma)
  101. { MOD_DEC_USE_COUNT; }
  104. /*
  105.  * The remap_page_range version of mmap.
  106.  */
  108. static struct vm_operations_struct simple_remap_vm_ops = {
  109.     open:  simple_vma_open,
  110.     close: simple_vma_close,
  111. };
  113. int simple_remap_mmap(struct file *filp, struct vm_area_struct *vma)
  114. {
  115.     unsigned long offset = VMA_OFFSET(vma);
  117.     if (offset >= __pa(high_memory) || (filp->f_flags & O_SYNC))
  118.         vma->vm_flags |= VM_IO;
  119.     vma->vm_flags |= VM_RESERVED;
  121.     if (remap_page_range(vma->vm_start, offset, vma->vm_end-vma->vm_start,
  122.                 vma->vm_page_prot))
  123.         return -EAGAIN;
  125.     vma->vm_ops = &simple_remap_vm_ops;
  126.     simple_vma_open(vma);
  127.     return 0;
  128. }
  132. /*
  133.  * The nopage version.
  134.  */
  135. struct page *simple_vma_nopage(struct vm_area_struct *vma,
  136.                 unsigned long address, int write_access)
  137. {
  138.     struct page *pageptr;
  139.     unsigned long physaddr = address - vma->vm_start + VMA_OFFSET(vma);
  140.     pageptr = virt_to_page(__va(physaddr));
  141.     get_page(pageptr);
  142.     return pageptr;
  143. }
  146. #ifdef LINUX_22 /* wrapper for 2.2, which had a different nopage retval */
  147. unsigned long simple_vma_nopage_22(struct vm_area_struct * area,
  148.                 unsigned long address, int write_access)
  149. {
  150.     return (unsigned long) simple_vma_nopage(area, address, write_access);
  151. }
  152. #define simple_vma_nopage simple_vma_nopage_22
  153. #endif  /* LINUX_22 */
  154.         
  155. static struct vm_operations_struct simple_nopage_vm_ops = {
  156.     open:    simple_vma_open,
  157.     close:   simple_vma_close,
  158.     nopage:  simple_vma_nopage,
  159. };
  162. int simple_nopage_mmap(struct file *filp, struct vm_area_struct *vma)
  163. {
  164.     unsigned long offset = VMA_OFFSET(vma);
  166.     if (offset >= __pa(high_memory) || (filp->f_flags & O_SYNC))
  167.         vma->vm_flags |= VM_IO;
  168.     vma->vm_flags |= VM_RESERVED;
  170.     vma->vm_ops = &simple_nopage_vm_ops;
  171.     simple_vma_open(vma);
  172.     return 0;
  173. }
  177. /*
  178.  * Module housekeeping.
  179.  */
  180. static int simple_init(void)
  181. {
  182.     int result;
  184.     SET_MODULE_OWNER(&simple_remap_ops);
  185.     SET_MODULE_OWNER(&simple_nopage_ops);
  187.     result = register_chrdev(simple_major, "simple", &simple_remap_ops);
  188.     if (result < 0)
  189.     {
  190.         printk(KERN_WARNING "simple: unable to get major %dn", simple_major);
  191.         return result;
  192.     }
  193.     if (simple_major == 0)
  194.         simple_major = result;
  195.     return 0;
  196. }
  199. static void simple_cleanup(void)
  200. {
  201.     unregister_chrdev(simple_major, "simple");
  202. }
  205. module_init(simple_init);
  206. module_exit(simple_cleanup);