devices.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:5k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/fs/devices.c
  3.  *
  4.  * (C) 1993 Matthias Urlichs -- collected common code and tables.
  5.  * 
  6.  *  Copyright (C) 1991, 1992  Linus Torvalds
  7.  *
  8.  *  Added kerneld support: Jacques Gelinas and Bjorn Ekwall
  9.  *  (changed to kmod)
  10.  */
  11. #include <linux/config.h>
  12. #include <linux/fs.h>
  13. #include <linux/major.h>
  14. #include <linux/string.h>
  15. #include <linux/sched.h>
  16. #include <linux/stat.h>
  17. #include <linux/fcntl.h>
  18. #include <linux/errno.h>
  19. #include <linux/module.h>
  20. #include <linux/smp_lock.h>
  21. #ifdef CONFIG_KMOD
  22. #include <linux/kmod.h>
  23. #include <linux/tty.h>
  24. /* serial module kmod load support */
  25. struct tty_driver *get_tty_driver(kdev_t device);
  26. #define isa_tty_dev(ma) (ma == TTY_MAJOR || ma == TTYAUX_MAJOR)
  27. #define need_serial(ma,mi) (get_tty_driver(MKDEV(ma,mi)) == NULL)
  28. #endif
  29. struct device_struct {
  30. const char * name;
  31. struct file_operations * fops;
  32. };
  33. static rwlock_t chrdevs_lock = RW_LOCK_UNLOCKED;
  34. static struct device_struct chrdevs[MAX_CHRDEV];
  35. extern int get_blkdev_list(char *);
  36. int get_device_list(char * page)
  37. {
  38. int i;
  39. int len;
  40. len = sprintf(page, "Character devices:n");
  41. read_lock(&chrdevs_lock);
  42. for (i = 0; i < MAX_CHRDEV ; i++) {
  43. if (chrdevs[i].fops) {
  44. len += sprintf(page+len, "%3d %sn", i, chrdevs[i].name);
  45. }
  46. }
  47. read_unlock(&chrdevs_lock);
  48. len += get_blkdev_list(page+len);
  49. return len;
  50. }
  51. /*
  52. Return the function table of a device.
  53. Load the driver if needed.
  54. Increment the reference count of module in question.
  55. */
  56. static struct file_operations * get_chrfops(unsigned int major, unsigned int minor)
  57. {
  58. struct file_operations *ret = NULL;
  59. if (!major || major >= MAX_CHRDEV)
  60. return NULL;
  61. read_lock(&chrdevs_lock);
  62. ret = fops_get(chrdevs[major].fops);
  63. read_unlock(&chrdevs_lock);
  64. #ifdef CONFIG_KMOD
  65. if (ret && isa_tty_dev(major)) {
  66. lock_kernel();
  67. if (need_serial(major,minor)) {
  68. /* Force request_module anyway, but what for? */
  69. fops_put(ret);
  70. ret = NULL;
  71. }
  72. unlock_kernel();
  73. }
  74. if (!ret) {
  75. char name[20];
  76. sprintf(name, "char-major-%d", major);
  77. request_module(name);
  78. read_lock(&chrdevs_lock);
  79. ret = fops_get(chrdevs[major].fops);
  80. read_unlock(&chrdevs_lock);
  81. }
  82. #endif
  83. return ret;
  84. }
  85. int register_chrdev(unsigned int major, const char * name, struct file_operations *fops)
  86. {
  87. if (major == 0) {
  88. write_lock(&chrdevs_lock);
  89. for (major = MAX_CHRDEV-1; major > 0; major--) {
  90. if (chrdevs[major].fops == NULL) {
  91. chrdevs[major].name = name;
  92. chrdevs[major].fops = fops;
  93. write_unlock(&chrdevs_lock);
  94. return major;
  95. }
  96. }
  97. write_unlock(&chrdevs_lock);
  98. return -EBUSY;
  99. }
  100. if (major >= MAX_CHRDEV)
  101. return -EINVAL;
  102. write_lock(&chrdevs_lock);
  103. if (chrdevs[major].fops && chrdevs[major].fops != fops) {
  104. write_unlock(&chrdevs_lock);
  105. return -EBUSY;
  106. }
  107. chrdevs[major].name = name;
  108. chrdevs[major].fops = fops;
  109. write_unlock(&chrdevs_lock);
  110. return 0;
  111. }
  112. int unregister_chrdev(unsigned int major, const char * name)
  113. {
  114. if (major >= MAX_CHRDEV)
  115. return -EINVAL;
  116. write_lock(&chrdevs_lock);
  117. if (!chrdevs[major].fops || strcmp(chrdevs[major].name, name)) {
  118. write_unlock(&chrdevs_lock);
  119. return -EINVAL;
  120. }
  121. chrdevs[major].name = NULL;
  122. chrdevs[major].fops = NULL;
  123. write_unlock(&chrdevs_lock);
  124. return 0;
  125. }
  126. /*
  127.  * Called every time a character special file is opened
  128.  */
  129. int chrdev_open(struct inode * inode, struct file * filp)
  130. {
  131. int ret = -ENODEV;
  132. filp->f_op = get_chrfops(MAJOR(inode->i_rdev), MINOR(inode->i_rdev));
  133. if (filp->f_op) {
  134. ret = 0;
  135. if (filp->f_op->open != NULL) {
  136. lock_kernel();
  137. ret = filp->f_op->open(inode,filp);
  138. unlock_kernel();
  139. }
  140. }
  141. return ret;
  142. }
  143. /*
  144.  * Dummy default file-operations: the only thing this does
  145.  * is contain the open that then fills in the correct operations
  146.  * depending on the special file...
  147.  */
  148. static struct file_operations def_chr_fops = {
  149. open: chrdev_open,
  150. };
  151. /*
  152.  * Print device name (in decimal, hexadecimal or symbolic)
  153.  * Note: returns pointer to static data!
  154.  */
  155. const char * kdevname(kdev_t dev)
  156. {
  157. static char buffer[32];
  158. sprintf(buffer, "%02x:%02x", MAJOR(dev), MINOR(dev));
  159. return buffer;
  160. }
  161. const char * cdevname(kdev_t dev)
  162. {
  163. static char buffer[32];
  164. const char * name = chrdevs[MAJOR(dev)].name;
  165. if (!name)
  166. name = "unknown-char";
  167. sprintf(buffer, "%s(%d,%d)", name, MAJOR(dev), MINOR(dev));
  168. return buffer;
  169. }
  170.   
  171. static int sock_no_open(struct inode *irrelevant, struct file *dontcare)
  172. {
  173. return -ENXIO;
  174. }
  175. static struct file_operations bad_sock_fops = {
  176. open: sock_no_open
  177. };
  178. void init_special_inode(struct inode *inode, umode_t mode, int rdev)
  179. {
  180. inode->i_mode = mode;
  181. if (S_ISCHR(mode)) {
  182. inode->i_fop = &def_chr_fops;
  183. inode->i_rdev = to_kdev_t(rdev);
  184. inode->i_cdev = cdget(rdev);
  185. } else if (S_ISBLK(mode)) {
  186. inode->i_fop = &def_blk_fops;
  187. inode->i_rdev = to_kdev_t(rdev);
  188. } else if (S_ISFIFO(mode))
  189. inode->i_fop = &def_fifo_fops;
  190. else if (S_ISSOCK(mode))
  191. inode->i_fop = &bad_sock_fops;
  192. else
  193. printk(KERN_DEBUG "init_special_inode: bogus imode (%o)n", mode);
  194. }