platform_main.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197
  1. #include <linux/module.h>
  2. #include <linux/kernel.h>
  3. #include <linux/init.h>
  4. #include <linux/cdev.h>
  5. #include <linux/fs.h>
  6. #include <linux/errno.h>
  7. #include <asm/current.h>
  8. #include <linux/kernel.h>
  9. #include <linux/sched.h>
  10. #include <linux/device.h>
  11. #include <linux/err.h>
  12. #include <linux/uaccess.h>
  13. #include <linux/irqreturn.h>
  14. #include <linux/interrupt.h>
  15. #include "stm32f4xx.h"
  16. #include "stm32f4xx_hal_cortex.h"
  17. static int major = 100;
  18. static int minor = 0;
  19. static dev_t devno;
  20. static struct cdev *platform_cdev = NULL;
  21. static int count = 1;
  22. #define DEVNAME "platform_STM32F429"
  23. struct device *dev = NULL;
  24. #define SET_PRIORITY_GROUP 0
  25. #define GET_PRIORITY_GROUP 1
  26. typedef struct {
  27. uint32_t priority_group;
  28. } platform_arg_t;
  29. static int platform_open(struct inode *inode, struct file *filep);
  30. static int platform_close(struct inode *inode, struct file *filep);
  31. static ssize_t platform_read(struct file *filep, char __user *buf, size_t size, loff_t *offset);
  32. static ssize_t platform_write(struct file *filep, const char __user *buf, size_t size, loff_t *offset);
  33. static int platform_ioctl(struct inode *indoe, struct file *filep, unsigned int cmd, unsigned long arg);
  34. static struct file_operations platform_ops =
  35. {
  36. .owner = THIS_MODULE,
  37. .open = platform_open,
  38. .release = platform_close,
  39. .read = platform_read,
  40. .write = platform_write,
  41. .ioctl = platform_ioctl,
  42. };
  43. static int platform_open(struct inode *inode, struct file *filep)
  44. {
  45. printk("---> platform open\n");
  46. return 0;
  47. }
  48. static int platform_close(struct inode *inode, struct file *filep)
  49. {
  50. printk("---> platform close\n");
  51. return 0;
  52. }
  53. static ssize_t platform_read(struct file *filep, char __user *buf, size_t size, loff_t *offset)
  54. {
  55. printk("---> platform read\n");
  56. return 0;
  57. }
  58. static ssize_t platform_write(struct file *filep, const char __user *buf, size_t size, loff_t *offset)
  59. {
  60. printk("---> platform write\n");
  61. return 0;
  62. }
  63. static int platform_ioctl(struct inode *indoe, struct file *filep, unsigned int cmd, unsigned long arg)
  64. {
  65. platform_arg_t platform_arg;
  66. if(copy_from_user( &platform_arg, (void*)arg, sizeof(platform_arg_t)))
  67. return -EFAULT;
  68. switch(cmd)
  69. {
  70. case SET_PRIORITY_GROUP:
  71. if((platform_arg.priority_group != NVIC_PRIORITYGROUP_0)
  72. && (platform_arg.priority_group != NVIC_PRIORITYGROUP_1)
  73. && (platform_arg.priority_group != NVIC_PRIORITYGROUP_2)
  74. && (platform_arg.priority_group != NVIC_PRIORITYGROUP_3))
  75. {
  76. printk(KERN_ERR"Invalid priority group\n");
  77. return -EFAULT;
  78. }
  79. HAL_NVIC_SetPriorityGrouping(platform_arg.priority_group);
  80. break;
  81. case GET_PRIORITY_GROUP:
  82. platform_arg.priority_group = HAL_NVIC_GetPriorityGrouping();
  83. if(copy_to_user((void*)arg, &platform_arg, sizeof(platform_arg_t)))
  84. return -EFAULT;
  85. break;
  86. default:
  87. printk(KERN_ERR"Invalid cmd\n");
  88. break;
  89. }
  90. return 0;
  91. }
  92. //extern __IO uint32_t uwTick;
  93. //irqreturn_t SysTick_Handler(int irqno, void *dev_id)
  94. //{
  95. // HAL_IncTick();
  96. // if((uwTick % 1000) == 0)
  97. // printk("uwTick = %d\n", uwTick);
  98. // return IRQ_HANDLED;
  99. //}
  100. extern uint32_t SystemCoreClock;
  101. void platform_hw_init(void)
  102. {
  103. /* Set Interrupt Group Priority */
  104. HAL_NVIC_SetPriorityGrouping(NVIC_PRIORITYGROUP_4);
  105. SystemCoreClockUpdate();
  106. // /* config SysTick 1KHZ */
  107. // SysTick->LOAD = (uint32_t)(SystemCoreClock / 1000U - 1UL); /* set reload register */
  108. // SysTick->VAL = 0UL; /* Load the SysTick Counter Value */
  109. // SysTick->CTRL = SysTick_CTRL_CLKSOURCE_Msk |
  110. // SysTick_CTRL_TICKINT_Msk |
  111. // SysTick_CTRL_ENABLE_Msk; /* Enable SysTick IRQ and SysTick Timer */
  112. //
  113. // HAL_NVIC_SetPriority (SysTick_IRQn, 15, 0); /* set Priority for Systick Interrupt */
  114. // HAL_NVIC_EnableIRQ(SysTick_IRQn);
  115. printk("STM32F429 SystemCoreClock: %d\n", SystemCoreClock);
  116. }
  117. static int __init platform_init(void)
  118. {
  119. int ret;
  120. platform_cdev = cdev_alloc();
  121. if(platform_cdev == NULL){
  122. return -ENOMEM;
  123. }
  124. cdev_init(platform_cdev,&platform_ops);
  125. devno = MKDEV(major,minor);
  126. ret = register_chrdev_region(devno, count, DEVNAME);
  127. if(ret){
  128. goto ERR_STEP;
  129. }
  130. ret = cdev_add(platform_cdev, devno, count);
  131. if(ret){
  132. goto ERR_STEP1;
  133. }
  134. platform_hw_init();
  135. // ret = request_irq(SysTick_IRQn,
  136. // SysTick_Handler,
  137. // IRQF_SHARED,
  138. // DEVNAME,
  139. // &devno);
  140. // if(ret) {
  141. // printk("request_irq() failed! %d\n", ret);
  142. // goto ERR_STEP1;
  143. // }
  144. printk("Platform_STM32F429 module insmod ok.\n");
  145. return 0;
  146. ERR_STEP1:
  147. unregister_chrdev_region(devno,count);
  148. ERR_STEP:
  149. cdev_del(platform_cdev);
  150. return ret;
  151. }
  152. static void __exit platform_exit(void)
  153. {
  154. unregister_chrdev_region(MKDEV(major,minor),count);
  155. cdev_del(platform_cdev);
  156. }
  157. module_init(platform_init);
  158. module_exit(platform_exit);
  159. MODULE_LICENSE("GPL");
  160. MODULE_AUTHOR("Jimbo");
  161. MODULE_DESCRIPTION("This module init STM32F429 interrupt group.\n");