leds_drv.h

[cpp]

1. #ifndef _MEMDEV_H_   

2. #define _MEMDEV_H_   

3. #include    

4. /* 定义幻数 */  

5. #define MEMDEV_IOC_MAGIC  'k'   

6. /* 定义命令 */  

7. #define MEMDEV_IOC_ON   _IO(MEMDEV_IOC_MAGIC, 1)   

8. #define MEMDEV_IOC_OFF _IO(MEMDEV_IOC_MAGIC, 2)   

9. #define MEMDEV_IOC_MAXNR 2   

10. #define LED_ON  0   

11. #define LED_OFF 1   

12. #endif                          /* _MEMDEV_H_ */  

leds_drv.c

[cpp]

1. #include    

2. #include    

3. #include    

4. #include    

5. #include    

6. #include    

7. #include    

8. #include    

9. #include    

10. #include    

11. #include    

12. #include    

13. #include    

14. #include    

15. #include    

16. #include    

17. #include    

18. #include    

19. #include    

20. #include    

21. #include    

22. #include    

23. #include    

24. #include    

25. #include    

26. #include    

27. #include    

28. #include    

29. #include    

30. #include    

31.   

32. #include "leds_drv.h"   

33.   

34. #define DEVICE_NAME "leds"   

35.   

36. static unsigned long led_table[] = {  

37.     S3C2410_GPB(5),  

38.     S3C2410_GPB(6),  

39.     S3C2410_GPB(7),  

40.     S3C2410_GPB(8),  

41. };  

42.   

43. static unsigned int led_cfg_table[] = {  

44.     S3C2410_GPIO_OUTPUT,  

45.     S3C2410_GPIO_OUTPUT,  

46.     S3C2410_GPIO_OUTPUT,  

47.     S3C2410_GPIO_OUTPUT,  

48. };  

49.   

50. static int s3c2440_leds_ioctl(struct inode *inode,  

51.                               struct file *file, unsigned int cmd, unsigned long arg)  

52. {  

53.   

54.     /* 检测命令的有效性 */  

55.     if (_IOC_TYPE(cmd) != MEMDEV_IOC_MAGIC)  

56.         return -EINVAL;  

57.     if (_IOC_NR(cmd) > MEMDEV_IOC_MAXNR)  

58.         return -EINVAL;  

59.   

60.     /* 根据命令，执行相应的操作 */  

61.     switch (cmd)  

62.     {  

63.       case MEMDEV_IOC_OFF:  

64.           s3c2410_gpio_setpin(led_table[arg], LED_OFF);  

65.           return 0;  

66.   

67.       case MEMDEV_IOC_ON:  

68.           s3c2410_gpio_setpin(led_table[arg], LED_ON);  

69.           return 0;  

70.       default:  

71.           return -EINVAL;  

72.     }  

73. }  

74.   

75. /*文件操作结构体*/  

76. static struct file_operations dev_fops = {  

77.     .owner = THIS_MODULE,  

78.     .ioctl = s3c2440_leds_ioctl,  

79. };  

80.   

81. static struct miscdevice misc = {  

82.     .minor = MISC_DYNAMIC_MINOR,  

83.     .name = DEVICE_NAME,  

84.     .fops = &dev_fops,  

85. };  

86.   

87. static int __init dev_init(void)  

88. {  

89.     int ret;  

90.   

91.     int i;  

92.     /*设置GPIO控制寄存器，GPIO设置为输出模式,默认下灯全灭 */  

93.     for (i = 0; i < 4; i++)  

94.     {  

95.         s3c2410_gpio_cfgpin(led_table[i], led_cfg_table[i]);  

96.         s3c2410_gpio_setpin(led_table[i], 1);  

97.     }  

98.     /*注册混杂型字符设备驱动 */  

99.     ret = misc_register(&misc);  

100.   

101.     printk(DEVICE_NAME "tinitializedn");  

102.   

103.     return ret;  

104. }  

105.   

106. static void __exit dev_exit(void)  

107. {  

108.     /*注销混杂型字符设备驱动 */  

109.     misc_deregister(&misc);  

110. }  

111.   

112. module_init(dev_init);  

113. module_exit(dev_exit);  

114.   

115. MODULE_AUTHOR("Cried Devil");  

116. MODULE_LICENSE("GPL");  

app-leds.c

[cpp]

1. #include    

2. #include    

3. #include    

4. #include    

5. #include "leds_drv.h"           /* 包含命令定义 */   

6. int main(int argc, char **argv)  

7. {  

8.     int on;  

9.     int fd;  

10.     int num;  

11.     if (argc != 3 ||  

12.         sscanf(argv[1],  

13.                "%d",  

14.                &num) !=  

15.         1 || sscanf(argv[2], "%d", &on) != 1 || on < 0 || on > 1 || num < 0 || num > 3)  

16.     {  

17.         fprintf(stderr, "Usage:  %s   led_num   off|onn", argv[0]);  

18.         fprintf(stderr, "Usage:  %s   0|1|2|3   0|1n", argv[0]);  

19.         fprintf(stderr, "Ex   :  %s   0         1n", argv[0]);  

20.         exit(1);  

21.     }  

22.     fd = open("/dev/leds", 0);  

23.     if (fd < 0)  

24.     {  

25.         perror("open device leds");  

26.         exit(1);  

27.     }  

28.   

29.     if (on)  

30.     {  

31.         // printf("Turn on led %d!n", num);   

32.         ioctl(fd, MEMDEV_IOC_ON, num);  

33.     }  

34.     else  

35.     {  

36.         // printf("Turn off led %d!n", num);   

37.         ioctl(fd, MEMDEV_IOC_OFF, num);  

38.     }  

39.     close(fd);  

40.     return 0;