drvmain.c 4.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187
  1. #include <linux/init.h>
  2. #include <linux/kernel.h> // printk()
  3. #include <linux/kobject.h> // struct kobject
  4. #include <linux/errno.h> // error codes
  5. #include <linux/module.h> // THIS_MODULE
  6. #include <linux/sysfs.h>
  7. #include <linux/syscalls.h>
  8. #include <asm/ioctls.h>
  9. #include <linux/spi/spidev.h>
  10. #include "kfile.h"
  11. /////////////////////////////////////////////////////////////////////////////
  12. MODULE_LICENSE("Dual BSD/GPL");
  13. MODULE_AUTHOR("GfA");
  14. /////////////////////////////////////////////////////////////////////////////
  15. #define _SPI_DEVICE "/dev/spidev1.0"
  16. static struct file *g_fdSpiDev = NULL;
  17. /////////////////////////////////////////////////////////////////////////////
  18. static int temp = 0;
  19. static struct kobject *pKoGfa = NULL, *pKoTiva = NULL;
  20. /////////////////////////////////////////////////////////////////////////////
  21. static ssize_t tivaTempShow(struct kobject *kobj, struct kobj_attribute *attr, char *buf)
  22. {
  23. printk(KERN_ALERT "tivaTemp - Read!!!\n");
  24. return sprintf(buf, "%d", ++temp);
  25. }
  26. static ssize_t tivaTempStore(struct kobject *kobj, struct kobj_attribute *attr, const char *buf, size_t count)
  27. {
  28. printk(KERN_ALERT "tivaTemp - Write!!!\n");
  29. sscanf(buf, "%d", &temp);
  30. return count;
  31. }
  32. /////////////////////////////////////////////////////////////////////////////
  33. static struct kobj_attribute tivaTempAtt = __ATTR(temp, 0660, tivaTempShow, tivaTempStore);
  34. /////////////////////////////////////////////////////////////////////////////
  35. static int drv_init(void)
  36. {
  37. long ret;
  38. uint8_t mode = SPI_MODE_3;
  39. uint8_t bits = 8;
  40. uint32_t speed = 1000000;
  41. /////////////////////////////////////////////////////////////////////////
  42. do
  43. {
  44. if(!(pKoGfa = kobject_create_and_add("gfa", /*kernel_kobj*/NULL)))
  45. {
  46. printk(KERN_ALERT "kobject_create_and_add failed\n");
  47. break;
  48. }
  49. if(!(pKoTiva = kobject_create_and_add("tiva", pKoGfa)))
  50. {
  51. printk(KERN_ALERT "kobject_create_and_add failed\n");
  52. break;
  53. }
  54. /////////////////////////////////////////////////////////////////////
  55. if(sysfs_create_file(pKoTiva, &tivaTempAtt.attr))
  56. {
  57. printk(KERN_ALERT "sysfs_create_file failed\n");
  58. break;
  59. }
  60. /////////////////////////////////////////////////////////////////////
  61. if(!(g_fdSpiDev = kf_open(_SPI_DEVICE, O_RDWR, 0)))
  62. {
  63. printk(KERN_ALERT "file_open failed\n");
  64. break;
  65. }
  66. /////////////////////////////////////////////////////////////////////
  67. ret = kf_ioctl(g_fdSpiDev, SPI_IOC_WR_MODE, (unsigned long)&mode);
  68. if(ret < 0)
  69. {
  70. printk(KERN_ALERT "can't set spi mode\n");
  71. break;
  72. }
  73. mode = 0;
  74. ret = kf_ioctl(g_fdSpiDev, SPI_IOC_RD_MODE, (unsigned long)&mode);
  75. if(ret < 0)
  76. {
  77. printk(KERN_ALERT "can't get spi mode\n");
  78. break;
  79. }
  80. ret = kf_ioctl(g_fdSpiDev, SPI_IOC_WR_BITS_PER_WORD, (unsigned long)&bits);
  81. if(ret < 0)
  82. {
  83. printk(KERN_ALERT "can't set bits per word\n");
  84. break;
  85. }
  86. bits = 0;
  87. ret = kf_ioctl(g_fdSpiDev, SPI_IOC_RD_BITS_PER_WORD, (unsigned long)&bits);
  88. if(ret < 0)
  89. {
  90. printk(KERN_ALERT "can't get bits per word\n");
  91. break;
  92. }
  93. ret = kf_ioctl(g_fdSpiDev, SPI_IOC_WR_MAX_SPEED_HZ, (unsigned long)&speed);
  94. if(ret < 0)
  95. {
  96. printk(KERN_ALERT "can't set max speed hz\n");
  97. break;
  98. }
  99. speed = 0;
  100. ret = kf_ioctl(g_fdSpiDev, SPI_IOC_RD_MAX_SPEED_HZ, (unsigned long)&speed);
  101. if(ret < 0)
  102. {
  103. printk(KERN_ALERT "can't get max speed hz\n");
  104. break;
  105. }
  106. /////////////////////////////////////////////////////////////////////
  107. printk(KERN_ALERT "mode: %hhu\n", mode);
  108. printk(KERN_ALERT "bits: %hhu\n", bits);
  109. printk(KERN_ALERT "speed: %u\n", speed);
  110. printk(KERN_ALERT "%s\n", __FUNCTION__);
  111. return 0;
  112. }
  113. while(0);
  114. /////////////////////////////////////////////////////////////////////////
  115. if(g_fdSpiDev)
  116. kf_close(g_fdSpiDev);
  117. if(pKoTiva)
  118. {
  119. sysfs_remove_file(pKoTiva, &tivaTempAtt.attr);
  120. kobject_put(pKoTiva);
  121. pKoTiva = NULL;
  122. }
  123. if(pKoGfa)
  124. {
  125. kobject_put(pKoGfa);
  126. pKoGfa = NULL;
  127. }
  128. return -ENOMEM;
  129. }
  130. /////////////////////////////////////////////////////////////////////////////
  131. static void drv_exit(void)
  132. {
  133. if(g_fdSpiDev)
  134. kf_close(g_fdSpiDev);
  135. if(pKoTiva)
  136. {
  137. sysfs_remove_file(pKoTiva, &tivaTempAtt.attr);
  138. kobject_put(pKoTiva);
  139. }
  140. if(pKoGfa)
  141. kobject_put(pKoGfa);
  142. printk(KERN_ALERT "%s\n", __FUNCTION__);
  143. }
  144. /////////////////////////////////////////////////////////////////////////////
  145. module_init(drv_init);
  146. module_exit(drv_exit);