gpio_i2c_main.c 7.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376
  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 "stm32f4xx.h"
  14. #include "stm32f4xx_hal_gpio.h"
  15. #include "stm32_hal_legacy.h"
  16. #include "driver.h"
  17. #include <linux/delay.h>
  18. static int major = MAJOR_GPIO_I2C;
  19. static int minor = 0;
  20. static dev_t devno;
  21. static struct cdev *gpio_i2c_cdev = NULL;
  22. static int count = 1;
  23. #define DEVNAME "gpio_i2c"
  24. static int gpio_i2c_open(struct inode *inode, struct file *filep);
  25. static int gpio_i2c_close(struct inode *inode, struct file *filep);
  26. static ssize_t gpio_i2c_read(struct file *filep, char __user *buf, size_t size, loff_t *offset);
  27. static ssize_t gpio_i2c_write(struct file *filep, const char __user *buf, size_t size, loff_t *offset);
  28. static int gpio_i2c_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg);
  29. static struct file_operations gpio_i2c_ops =
  30. {
  31. .owner = THIS_MODULE,
  32. .open = gpio_i2c_open,
  33. .release = gpio_i2c_close,
  34. .ioctl = gpio_i2c_ioctl,
  35. .read = gpio_i2c_read,
  36. .write = gpio_i2c_write,
  37. };
  38. #define SCL_PORT GPIOC
  39. #define SCL_PIN GPIO_PIN_9
  40. #define SDA_PORT GPIOA
  41. #define SDA_PIN GPIO_PIN_8
  42. #define SCLK_Set() HAL_GPIO_WritePin(SCL_PORT, SCL_PIN, 1);
  43. #define SCLK_Clr() HAL_GPIO_WritePin(SCL_PORT, SCL_PIN, 0);
  44. #define SDIN_Set() HAL_GPIO_WritePin(SDA_PORT, SDA_PIN, 1);
  45. #define SDIN_Clr() HAL_GPIO_WritePin(SDA_PORT, SDA_PIN, 0);
  46. void IIC_Start(void)
  47. {
  48. SCLK_Set();
  49. SDIN_Set();
  50. udelay(1);
  51. SDIN_Clr();
  52. }
  53. /**********************************************
  54. //IIC Stop
  55. **********************************************/
  56. void IIC_Stop(void)
  57. {
  58. SCLK_Clr();
  59. SDIN_Clr();
  60. SCLK_Set();
  61. udelay(1);
  62. SDIN_Set();
  63. }
  64. void IIC_Ack(void)
  65. {
  66. SCLK_Clr();
  67. SDIN_Clr();
  68. udelay(1);
  69. SCLK_Set();
  70. udelay(1);
  71. SCLK_Clr();
  72. SDIN_Set(); //release SDA
  73. }
  74. void IIC_NoAck(void)
  75. {
  76. SCLK_Clr();
  77. SDIN_Set();
  78. udelay(1);
  79. SCLK_Set();
  80. udelay(1);
  81. SCLK_Clr();
  82. SDIN_Set(); //release SDA
  83. }
  84. int IIC_Wait_Ack(void)
  85. {
  86. uint8_t ack = 0;
  87. SCLK_Clr();
  88. SDIN_Set(); //release SDA
  89. udelay(1);
  90. SCLK_Set() ;
  91. udelay(1);
  92. ack = HAL_GPIO_ReadPin(SDA_PORT, SDA_PIN);
  93. SCLK_Clr();
  94. return ack;
  95. }
  96. void Write_IIC_Byte(unsigned char IIC_Byte)
  97. {
  98. unsigned char i;
  99. unsigned char m,da;
  100. da=IIC_Byte;
  101. SCLK_Clr();
  102. for(i=0;i<8;i++)
  103. {
  104. m=da;
  105. m=m&0x80;
  106. if(m==0x80)
  107. {
  108. SDIN_Set();
  109. }
  110. else
  111. {
  112. SDIN_Clr();
  113. }
  114. da=da<<1;
  115. udelay(1);
  116. SCLK_Set();
  117. udelay(1);
  118. SCLK_Clr();
  119. }
  120. }
  121. unsigned char Read_IIC_Byte(void)
  122. {
  123. unsigned char i;
  124. unsigned int da = 0;
  125. SCLK_Clr();
  126. SDIN_Set(); //release SDA
  127. for(i=0;i<8;i++) //8
  128. {
  129. da=da<<1 ;
  130. udelay(1);
  131. SCLK_Set();
  132. if(HAL_GPIO_ReadPin(SDA_PORT, SDA_PIN) == 1)
  133. {da++;}
  134. udelay(1);
  135. SCLK_Clr();
  136. }
  137. return da;
  138. }
  139. static int master_write(uint8_t slave_addr, uint8_t *buf, uint32_t size)
  140. {
  141. int i;
  142. IIC_Start();
  143. Write_IIC_Byte(slave_addr); //Slave address,SA0=0 90
  144. if(IIC_Wait_Ack() != 0)
  145. {
  146. IIC_Stop();
  147. return -1;
  148. }
  149. for(i=0;i<size;i++)
  150. {
  151. Write_IIC_Byte(buf[i]); //write command
  152. IIC_Wait_Ack();
  153. }
  154. IIC_Stop();
  155. return 0;
  156. }
  157. static int master_read(uint8_t slave_addr, uint8_t *buf, uint32_t size)
  158. {
  159. int i;
  160. IIC_Start();
  161. Write_IIC_Byte(slave_addr+1); //Slave address
  162. if(IIC_Wait_Ack() != 0)
  163. {
  164. IIC_Stop();
  165. return -1;
  166. }
  167. for(i=0;i<size-1;i++)
  168. {
  169. udelay(1);
  170. buf[i] = Read_IIC_Byte();
  171. IIC_Ack();
  172. }
  173. udelay(1);
  174. buf[i] = Read_IIC_Byte();
  175. IIC_NoAck();
  176. IIC_Stop();
  177. return 0;
  178. }
  179. static int master_write_read(uint8_t slave_addr, uint8_t *wrbuf, uint8_t wrsize, uint8_t *rdbuf, uint32_t rdsize)
  180. {
  181. int i;
  182. IIC_Start();
  183. Write_IIC_Byte(slave_addr); //Slave address,SA0=0 90
  184. if(IIC_Wait_Ack() != 0)
  185. {
  186. IIC_Stop();
  187. return -1;
  188. }
  189. for(i=0;i<wrsize;i++)
  190. {
  191. Write_IIC_Byte(wrbuf[i]); //write command
  192. IIC_Wait_Ack();
  193. }
  194. udelay(100);
  195. IIC_Start();
  196. Write_IIC_Byte(slave_addr+1); //Slave address
  197. if(IIC_Wait_Ack() != 0)
  198. {
  199. IIC_Stop();
  200. return -1;
  201. }
  202. for(i=0;i<rdsize-1;i++)
  203. {
  204. udelay(1);
  205. rdbuf[i] = Read_IIC_Byte();
  206. IIC_Ack();
  207. }
  208. udelay(1);
  209. rdbuf[i] = Read_IIC_Byte();
  210. IIC_NoAck();
  211. IIC_Stop();
  212. return 0;
  213. }
  214. static int gpio_i2c_open(struct inode *inode, struct file *filep)
  215. {
  216. //__HAL_RCC_GPIOC_CLK_ENABLE();
  217. return 0;
  218. }
  219. static int gpio_i2c_close(struct inode *inode, struct file *filep)
  220. {
  221. return 0;
  222. }
  223. static int gpio_i2c_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg)
  224. {
  225. int ret = 0;
  226. gpio_i2c_t gpio_i2c_arg;
  227. switch(cmd)
  228. {
  229. case GPIO_I2C_MASTER_TRANSFER:
  230. if ( copy_from_user(&gpio_i2c_arg, (void*)arg, sizeof(gpio_i2c_t)) )
  231. return -EFAULT;
  232. ret = master_write(gpio_i2c_arg.DevAddress&0xFE, gpio_i2c_arg.Buf, gpio_i2c_arg.WriteLen );
  233. break;
  234. case GPIO_I2C_MASTER_RECEIVE:
  235. if ( copy_from_user(&gpio_i2c_arg, (void*)arg, 3) )
  236. return -EFAULT;
  237. ret = master_read(gpio_i2c_arg.DevAddress&0xFE, gpio_i2c_arg.Buf, gpio_i2c_arg.ReadLen );
  238. if(ret != 0)
  239. {
  240. break;
  241. }
  242. if ( copy_to_user((void*)arg, (void*)&gpio_i2c_arg, 3+gpio_i2c_arg.ReadLen))
  243. return -EFAULT;
  244. break;
  245. case GPIO_I2C_MASTER_TRANSFER_RECV:
  246. if ( copy_from_user(&gpio_i2c_arg, (void*)arg, sizeof(gpio_i2c_t)) )
  247. return -EFAULT;
  248. ret = master_write_read(gpio_i2c_arg.DevAddress&0xFE, gpio_i2c_arg.Buf, gpio_i2c_arg.WriteLen, gpio_i2c_arg.Buf, gpio_i2c_arg.ReadLen);
  249. if(ret != 0)
  250. {
  251. break;
  252. }
  253. if ( copy_to_user((void*)arg, (void*)&gpio_i2c_arg, 3+gpio_i2c_arg.ReadLen))
  254. return -EFAULT;
  255. break;
  256. default:
  257. printk("---> Invalid action\n");
  258. return -EINVAL;
  259. break;
  260. }
  261. return ret;
  262. }
  263. static ssize_t gpio_i2c_read(struct file *filep, char __user *buf, size_t size, loff_t *offset)
  264. {
  265. return 0;
  266. }
  267. static ssize_t gpio_i2c_write(struct file *filep, const char __user *buf, size_t size, loff_t *offset)
  268. {
  269. return 0;
  270. }
  271. static void gpio_i2c_hw_init(void)
  272. {
  273. GPIO_InitTypeDef GPIO_InitStruct;
  274. //config gpio
  275. GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_OD;
  276. GPIO_InitStruct.Pull = GPIO_PULLUP;
  277. GPIO_InitStruct.Speed = GPIO_SPEED_FAST;
  278. //SCL
  279. GPIO_InitStruct.Pin = SCL_PIN;
  280. HAL_GPIO_Init(SCL_PORT, &GPIO_InitStruct);
  281. //SDA
  282. GPIO_InitStruct.Pin = SDA_PIN;
  283. HAL_GPIO_Init(SDA_PORT, &GPIO_InitStruct);
  284. }
  285. static int __init gpio_i2c_init(void)
  286. {
  287. int ret;
  288. gpio_i2c_cdev = cdev_alloc();
  289. if(gpio_i2c_cdev == NULL){
  290. return -ENOMEM;
  291. }
  292. cdev_init(gpio_i2c_cdev,&gpio_i2c_ops);
  293. devno = MKDEV(major,minor);
  294. ret = register_chrdev_region(devno, count, DEVNAME);
  295. if(ret){
  296. goto ERR_STEP;
  297. }
  298. ret = cdev_add(gpio_i2c_cdev, devno, count);
  299. if(ret){
  300. goto ERR_STEP1;
  301. }
  302. gpio_i2c_hw_init();
  303. printk("gpio_i2c module start...\n");
  304. return 0;
  305. ERR_STEP1:
  306. unregister_chrdev_region(devno,count);
  307. ERR_STEP:
  308. cdev_del(gpio_i2c_cdev);
  309. return ret;
  310. }
  311. static void __exit gpio_i2c_exit(void)
  312. {
  313. unregister_chrdev_region(MKDEV(major,minor),count);
  314. cdev_del(gpio_i2c_cdev);
  315. }
  316. module_init(gpio_i2c_init);
  317. module_exit(gpio_i2c_exit);
  318. MODULE_LICENSE("GPL");
  319. MODULE_AUTHOR("Jimbo");
  320. MODULE_DESCRIPTION("this is gpio_i2c module");