gpio_main.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171
  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 <asm/uaccess.h>
  13. //#include <stdint.h>
  14. #include "stm32f4xx.h"
  15. #include "stm32f4xx_hal_gpio.h"
  16. #include "driver.h"
  17. #include "stm32_hal_legacy.h"
  18. static int major = MAJOR_GPIO;
  19. static int minor = 0;
  20. static dev_t devno;
  21. static struct cdev *gpio_cdev = NULL;
  22. static int count = 3;
  23. #define DEVNAME "gpio"
  24. static int gpio_open(struct inode *inode, struct file *filep);
  25. static int gpio_close(struct inode *inode, struct file *filep);
  26. static ssize_t gpio_read(struct file *filep, char __user *buf, size_t size, loff_t *offset);
  27. static ssize_t gpio_write(struct file *filep, const char __user *buf, size_t size, loff_t *offset);
  28. static int gpio_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg);
  29. static struct file_operations gpio_ops =
  30. {
  31. .owner = THIS_MODULE,
  32. .open = gpio_open,
  33. .release = gpio_close,
  34. .ioctl = gpio_ioctl,
  35. .read = gpio_read,
  36. .write = gpio_write,
  37. };
  38. static int gpio_open(struct inode *inode, struct file *filep)
  39. {
  40. return 0;
  41. }
  42. static int gpio_close(struct inode *inode, struct file *filep)
  43. {
  44. return 0;
  45. }
  46. static int gpio_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg)
  47. {
  48. uint32_t temp;
  49. uint32_t ioposition;
  50. uint32_t iocurrent;
  51. uint32_t position;
  52. gpio_t gpio_arg;
  53. if ( copy_from_user(&gpio_arg, (void*)arg, sizeof(gpio_t)) )
  54. return -EFAULT;
  55. switch(cmd)
  56. {
  57. case GPIO_INIT:
  58. switch((uint32_t)gpio_arg.GPIOx)
  59. {
  60. case (uint32_t)GPIOA: __GPIOA_CLK_ENABLE(); break;
  61. case (uint32_t)GPIOB: __GPIOB_CLK_ENABLE(); break;
  62. case (uint32_t)GPIOC: __GPIOC_CLK_ENABLE(); break;
  63. case (uint32_t)GPIOD: __GPIOD_CLK_ENABLE(); break;
  64. case (uint32_t)GPIOE: __GPIOE_CLK_ENABLE(); break;
  65. case (uint32_t)GPIOF: __GPIOF_CLK_ENABLE(); break;
  66. case (uint32_t)GPIOG: __GPIOG_CLK_ENABLE(); break;
  67. case (uint32_t)GPIOH: __GPIOH_CLK_ENABLE(); break;
  68. case (uint32_t)GPIOI: __GPIOI_CLK_ENABLE(); break;
  69. }
  70. HAL_GPIO_Init(gpio_arg.GPIOx, &gpio_arg.GPIO_Init);
  71. break;
  72. case GPIO_WRITE_PIN:
  73. HAL_GPIO_WritePin(gpio_arg.GPIOx, gpio_arg.GPIO_pin, gpio_arg.Data);
  74. break;
  75. case GPIO_READ_PIN:
  76. gpio_arg.Data = HAL_GPIO_ReadPin(gpio_arg.GPIOx, gpio_arg.GPIO_pin);
  77. if ( copy_to_user((void*)arg, (void*)&gpio_arg, sizeof(gpio_t)))
  78. return -EFAULT;
  79. break;
  80. case GPIO_SET_DIR:
  81. /* Configure the port pins */
  82. for(position = 0U; position < 16; position++)
  83. {
  84. /* Get the IO position */
  85. ioposition = 0x01U << position;
  86. /* Get the current IO position */
  87. iocurrent = (uint32_t)(gpio_arg.GPIO_pin) & ioposition;
  88. if(iocurrent == ioposition)
  89. {
  90. temp = gpio_arg.GPIOx->MODER;
  91. temp &= ~(GPIO_MODER_MODER0 << (position * 2U));
  92. temp |= (gpio_arg.Direct << (position * 2U));
  93. gpio_arg.GPIOx->MODER = temp;
  94. }
  95. }
  96. break;
  97. default:
  98. printk("---> Invalid action\n");
  99. return -EINVAL;
  100. break;
  101. }
  102. return 0;
  103. }
  104. static ssize_t gpio_read(struct file *filep, char __user *buf, size_t size, loff_t *offset)
  105. {
  106. return 0;
  107. }
  108. static ssize_t gpio_write(struct file *filep, const char __user *buf, size_t size, loff_t *offset)
  109. {
  110. return 0;
  111. }
  112. static int __init gpio_init(void)
  113. {
  114. int ret;
  115. gpio_cdev = cdev_alloc();
  116. if(gpio_cdev == NULL){
  117. return -ENOMEM;
  118. }
  119. cdev_init(gpio_cdev,&gpio_ops);
  120. devno = MKDEV(major,minor);
  121. ret = register_chrdev_region(devno, count, DEVNAME);
  122. if(ret){
  123. goto ERR_STEP;
  124. }
  125. ret = cdev_add(gpio_cdev, devno, count);
  126. if(ret){
  127. goto ERR_STEP1;
  128. }
  129. return 0;
  130. ERR_STEP1:
  131. unregister_chrdev_region(devno,count);
  132. ERR_STEP:
  133. cdev_del(gpio_cdev);
  134. return ret;
  135. }
  136. static void __exit gpio_exit(void)
  137. {
  138. unregister_chrdev_region(MKDEV(major,minor),count);
  139. cdev_del(gpio_cdev);
  140. }
  141. module_init(gpio_init);
  142. module_exit(gpio_exit);
  143. MODULE_LICENSE("GPL");
  144. MODULE_AUTHOR("Jimbo");
  145. MODULE_DESCRIPTION("this is gpio module");