2.6.16下控制键盘灯的设备驱动代码

yanshi1984

大家看看有什么改进的地方
#include<linux/module.h>
#include<linux/config.h>
#include<linux/init.h>
#include<linux/tty.h>
#include<linux/kd.h>
#include<linux/console_struct.h>
#include<linux/interrupt.h>

MODULE_LICENSE("GPL");

struct timer_list my_timer;
struct tty_driver *my_driver;
struct cdev *char_dev;
unsigned long led_seq = 1;

#define BLINK_DELAY HZ/5
#define LED_FIRST 0x02
#define LED_SECOND 0x04
#define LED_THIRD 0x01
#define LED_ALL 0x07

#define RESTORE_LEDS 0xFF
#define LED_LIGHT 0x01
#define LED_DARK 0x02

static void my_timer_func(unsigned long ptr)
{
        if(ptr == 1){
                (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,RESTORE_LEDS);
                (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,LED_FIRST);
               
          led_seq = 2;
          my_timer.data = led_seq;
          my_timer.expires = jiffies + BLINK_DELAY;
          add_timer(&my_timer);
        }
        if(ptr == 2){
                (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,RESTORE_LEDS);
                (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,LED_SECOND);
               
          led_seq = 3;
          my_timer.data = led_seq;
          my_timer.expires = jiffies + BLINK_DELAY;
          add_timer(&my_timer);
        }
        if(ptr == 3)
        {
                (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,RESTORE_LEDS);
                (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,LED_SECOND);
               
          led_seq = 1;
          my_timer.data = led_seq;
          my_timer.expires = jiffies + BLINK_DELAY;
          add_timer(&my_timer);
        }
}

static int device_open(struct inode *inode,struct file *file)
{
        int i;
        for(i=0; i<MAX_NR_CONSOLES;i++){
                if(!vc_cons[i].d)
                break;
        }
        my_driver = vc_cons[fg_console].d->vc_tty->driver;
       
        init_timer(&my_timer);
        my_timer.fucction = my_timer_func;
        my_timer.data = led_seq;
        my_timer.expires = jiffies + BLINK_DELAY;
        add_timer(&my_timer);
       
        return 0;
}

static int device_release(struct inode *inode,struct file *file)
{
        del_timer(&my_timer);
        return 0;
}

static ssize_t device_read(struct file *file,char * buf,size_t count,loff_t *ppos)
{
        return 0;
}

static ssize_t device_write(struct file *file,char * buf,size_t count,loff_t *ppos)
{
        return 0;
}

static int device_ioctl(struct inode *inode,struct file *file,unsigned int cmd,unsigned long arg)
{
        switch(cmd){
                case LED_LIGHT:
                        (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,LED_ALL);
                        break;
                case LED_DARK:
                        (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,RESTORE_LEDS);
                        break;
                default:break;                       
        }
        return 0;
}

struct file_operations device_ops = {
                                                .owner = THIS_MODULE,
                                                .llseek = NULL,
                                                .read = device_read,
                                                .write = device_write,
                                                .readdir = NULL,
                                                .poll = NULL,
                                                .ioctl = device_ioctl,
                                                .mmap = NULL,
                                                .open = device_open,
                                                .flush = NULL,
                                                .release = device_release,
                                                .fsync = NULL,
                                                .fasync = NULL,
                                                .lock = NULL,
                                                .readv = NULL,
                                                .writev = NULL,
}

static int __init kbleds_init(void)
{
        int i,ret;
        int chardev_major;
        dev_t dev = 0;
        ret = alloc_chrdev_region(&dev,0,1,"char_dev");
        chardev_major = MAJOR(dev);
        if(ret < 0)
                printk(KERN_WARNING "alloction device number failed.\n");
               
        printk("char_dev major number:%d\n",chardev_major);
        char_dev = cdev_alloc();
        cdev_init(char_dev,&device_ops);
        cdev_add(char_dev,dev,1);
       
        for(i=0; i<MAX_NR_CONSOLES; i++){
                if(!vc_cons[i].d)
                break;
        }
        my_driver = vc_cons[fg_console].d->vc_tty->driver;
        return 0;
}

static void __exit kbleds_cleanup(void)
{
        cdev_del(char_dev);
        unregister_chardev_region(dev,1);
        (my_driver->ioctl)(vc_cons[fg_console].d->vc_tty,NULL,KDSETLED,RESTORE_LEDS);
}

module_init(kbleds_init);
module_exit(kbleds_cleanup);

yanshi1984

自己顶

toughie

UP 好好干，继续努力

eagle1597

这样可以达到效果吗?贴个应用程序出来看下.

yanshi1984

不用应用程序.加载就亮.

gothicane

正在学习，有启发～～～
顶～～

pcs306

学习学习

helight

不是吧，这好像是使用的现成的驱动来作的，你在这个程序里只是调用了一下原有的驱动。不过做得还是很不错。可以试着作一下直接控制

anhongkui

1. 
   
2. [root@antty temp]# make -C /usr/src/linux M=`pwd` modules
   
3. make: Entering directory `/usr/src/linux-2.6.24'
   
4.   CC [M]  /root/temp/1.o
   
5. /root/temp/1.c:2:25: error: linux/config.h: No such file or directory
   
6. /root/temp/1.c: In function 'my_timer_func':
   
7. /root/temp/1.c:29: error: 'fg_console' undeclared (first use in this function)
   
8. /root/temp/1.c:29: error: (Each undeclared identifier is reported only once
   
9. /root/temp/1.c:29: error: for each function it appears in.)
   
10. /root/temp/1.c: In function 'device_open':
    
11. /root/temp/1.c:65: error: 'fg_console' undeclared (first use in this function)
    
12. /root/temp/1.c:68: error: 'struct timer_list' has no member named 'fucction'
    
13. /root/temp/1.c: In function 'device_ioctl':
    
14. /root/temp/1.c:96: error: 'fg_console' undeclared (first use in this function)
    
15. /root/temp/1.c: At top level:
    
16. /root/temp/1.c:110: warning: initialization from incompatible pointer type
    
17. /root/temp/1.c:121: error: unknown field 'readv' specified in initializer
    
18. /root/temp/1.c:122: error: unknown field 'writev' specified in initializer
    
19. /root/temp/1.c:125: error: expected ',' or ';' before 'static'
    
20. /root/temp/1.c: In function 'kbleds_cleanup':
    
21. /root/temp/1.c:151: error: implicit declaration of function 'unregister_chardev_region'
    
22. /root/temp/1.c:151: error: 'dev' undeclared (first use in this function)
    
23. /root/temp/1.c:152: error: 'fg_console' undeclared (first use in this function)
    
24. /root/temp/1.c: In function '__inittest':
    
25. /root/temp/1.c:155: error: 'kbleds_init' undeclared (first use in this function)
    
26. make[1]: *** [/root/temp/1.o] Error 1
    
27. make: *** [_module_/root/temp] Error 2
    
28. make: Leaving directory `/usr/src/linux-2.6.24'
    
29. [root@antty temp]#
    
30. 
    

复制代码

建议楼主说一下平台

mailwxg

原帖由 anhongkui 于 2008-7-16 15:35 发表

[root@antty temp]# make -C /usr/src/linux M=`pwd` modules
make: Entering directory `/usr/src/linux-2.6.24'
  CC [M]  /root/temp/1.o
/root/temp/1.c:2:25: error: linux/config.h: No such file o ...

'fg_console' undeclared (first use in this function)
这个错误原因我找到了：在2.6.28内核下，要包含头文件<linux/console_struct.h>
别的原因自己看看吧，我编译这个键盘灯程序就这一个问题~~