Advertisement
Guest User

Untitled

a guest
Aug 9th, 2019
185
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 4.02 KB | None | 0 0
  1. #include <linux/init.h>
  2. #include <linux/module.h>
  3. #include <linux/kernel.h>
  4. #include <linux/proc_fs.h>
  5. #include <linux/uaccess.h>
  6. #include <linux/slab.h>
  7. #include <linux/stat.h>
  8.  
  9.  
  10. MODULE_LICENSE("GPL");
  11. MODULE_AUTHOR("Anton Khokhlov");
  12. MODULE_DESCRIPTION("A simple message queue Linux module.");
  13. MODULE_VERSION("0.01");
  14.  
  15. #define MESSAGE_SIZE 65536
  16. #define QUEUE_SIZE 1024
  17. #define PROC_ENTRY_FILENAME "lkm_queue"
  18.  
  19. typedef struct message_item
  20. {
  21. struct message_item *next;
  22. //int message_type;
  23. char *message;
  24. size_t message_size;
  25. int dirty;
  26. } message_item;
  27.  
  28. struct message_queue
  29. {
  30. message_item *front;
  31. message_item *back;
  32. size_t size;
  33. } queue;
  34.  
  35.  
  36. static ssize_t push_queue(struct file *filp, const char *buf, size_t count, loff_t *offp)
  37. {
  38. if (count > MESSAGE_SIZE)
  39. {
  40. printk(KERN_WARNING "Message size is too big!\n");
  41. return 0;
  42. }
  43.  
  44. if (queue.size >= QUEUE_SIZE)
  45. {
  46. printk(KERN_WARNING "Queue is full!\n");
  47. return 0;
  48. }
  49.  
  50. if (queue.size == 0)
  51. {
  52. queue.back = queue.front = NULL;
  53. }
  54.  
  55. char *msg = kmalloc(count * sizeof(char), GFP_KERNEL);
  56.  
  57. if (copy_from_user(msg, (void*)buf, count))
  58. {
  59. printk(KERN_ERR "Error copy a block of data from user space!\n");
  60. return 1;
  61. }
  62.  
  63. message_item *new_mes_item = kmalloc(sizeof(message_item), GFP_KERNEL);
  64. new_mes_item->next = NULL;
  65. new_mes_item->message = msg;
  66. new_mes_item->message_size = count;
  67. new_mes_item->dirty = 0;
  68.  
  69. if (queue.size == 0)
  70. {
  71. queue.front = new_mes_item;
  72. queue.back = queue.front;
  73. }
  74. else
  75. {
  76. queue.back->next = new_mes_item;
  77. queue.back = new_mes_item;
  78. }
  79. queue.size++;
  80.  
  81. return count;
  82. }
  83.  
  84. static ssize_t pop_queue(struct file *filp, char *buf, size_t count, loff_t *offp)
  85. {
  86. message_item *front_mes_item;
  87. int ret;
  88.  
  89. if (queue.size == 0)
  90. {
  91. //const char *empstr = "Queue is empty!\n";
  92. //int emplen = strlen(empstr);
  93. //copy_to_user(buf, empstr, count);
  94. printk(KERN_WARNING "Queue is empty!\n");
  95. return 0/*emplen*/;
  96. }
  97.  
  98. front_mes_item = queue.front;
  99. if (front_mes_item->dirty == 0) {
  100. ret = copy_to_user(buf, front_mes_item->message, front_mes_item->message_size);
  101. front_mes_item->dirty = 1;
  102. ret = front_mes_item->message_size;
  103. } else {
  104. queue.front = queue.front->next;
  105.  
  106. kfree(front_mes_item);
  107.  
  108. queue.size--;
  109.  
  110. if (queue.size == 0)
  111. {
  112. queue.back = queue.front = NULL;
  113. }
  114.  
  115. ret = 0;
  116. }
  117.  
  118. return ret;
  119. }
  120.  
  121.  
  122. static const struct file_operations node_fops = {
  123. .owner = THIS_MODULE,
  124. .read = pop_queue,
  125. .write = push_queue
  126. };
  127.  
  128.  
  129. static int __init lkm_example_init(void)
  130. {
  131. printk(KERN_INFO "Initializing message queue linux kernel module...\n");
  132. struct proc_dir_entry *own_proc_node;
  133. //own_proc_node = create_proc_entry(PROC_ENTRY_FILENAME, S_IFREG | S_IRUGO | S_IWUGO, NULL);
  134. own_proc_node = proc_create(PROC_ENTRY_FILENAME, 0777, NULL, &node_fops);
  135. if(own_proc_node == NULL)
  136. {
  137. printk( KERN_ERR "Can't create /proc/%s\n", PROC_ENTRY_FILENAME );
  138. return -ENOMEM;
  139. }
  140. //own_proc_node->uid = 0;
  141. //own_proc_node->gid = 0;
  142. //own_proc_node->proc_fops = &node_fops;
  143. queue.size = 0;
  144. printk(KERN_INFO "Message queue LKM initialized.\n");
  145. return 0;
  146. }
  147.  
  148. static void __exit lkm_example_exit(void)
  149. {
  150. printk(KERN_INFO "End of message queue linux kernel module...\n");
  151. remove_proc_entry(PROC_ENTRY_FILENAME, NULL);
  152. }
  153.  
  154. module_init(lkm_example_init);
  155. module_exit(lkm_example_exit);
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement