Пособие по программированию модулей ядра Linux. Ч.6

/* 
 * print_string.c – отправляет вывод на tty, с которого мы работаем, 
 * будь то через X11, telnet и т.д. Для этого мы выводим строку на 
 * tty, связанный с текущей задачей. 
 */ 
#include <linux/init.h> 
#include <linux/kernel.h> 
#include <linux/module.h> 
#include <linux/sched.h> /* Для current. */ 
#include <linux/tty.h> /* Для объявлений tty. */ 
 
static void print_string(char *str) 
{ 
    /* tty для текущей задачи. */ 
    struct tty_struct *my_tty = get_current_tty(); 
 
    /* Если my_tty равен NULL, значит у текущей задачи нет tty, куда 
     * можно было бы произвести вывод (например, если это демон). В таком  
     * случае ничего не поделаешь.
     */ 
    if (my_tty) { 
        const struct tty_operations *ttyops = my_tty->driver->ops; 
        /* my_tty->driver – это структура, где расположены функции tty,
         * одна из которых (write) используется для записи строк в tty. 
         * С помощью нее можно извлекать строки из сегментов пространства памяти ядра или 
         * пользователя. 
         * 
         * Первый параметр этой функции устанавливает tty, куда нужно
         * производить запись, потому что одна и та же функция служит
         * для записи во все tty определенного типа. 
         * Второй параметр – это указатель на строку. 
         * Третий параметр устанавливает длину строки. 
         * 
         * Как вы увидите ниже, иногда необходимо использовать функционал 
         * препроцессора, чтобы получить код, работающий для различных
         * версий ядра. Реализованный нами здесь наивный подход плохо 
         * масштабируется. Правильный способ решения этой проблемы описан 
         * в разделе 2 документации: linux/Documentation/SubmittingPatches 
         */ 
        (ttyops->write)(my_tty, /* Сам tty. */ 
                        str, /* Строка. */ 
                        strlen(str)); /* Длина. */ 
 
        /* Изначально телетайпы были аппаратными и, как правило, строго 
         * следовали стандарту ASCII. В ASCII для перехода на новую строку 
         * необходимо два символа, возврат каретки и перевод строки. В 
         * Unix перевод строки ASCII задействуется для того и другого,
         * поэтому нельзя просто использовать n, так как возврата
         * каретки не произойдет, и следующая строка начнется в столбце, 
         * идущим сразу за переводом строки.
         *
         * Именно поэтому в Unix и MS Windows текстовые файлы отличаются.      
         * В CP/M и ее производных вроде MS-DOS и MS Windows текст строго 
         * подчиняется стандарту ASCII, в связи с чем для перехода на 
         * новую строку требуется и LF, и CR. 
         */ 
        (ttyops->write)(my_tty, "1512", 2); 
    } 
} 
 
static int __init print_string_init(void) 
{ 
    print_string("The module has been inserted.  Hello world!"); 
    return 0; 
} 
 
static void __exit print_string_exit(void) 
{ 
    print_string("The module has been removed.  Farewell world!"); 
} 
 
module_init(print_string_init); 
module_exit(print_string_exit); 
 
MODULE_LICENSE("GPL");

/* 
 * kbleds.c – мигает светодиодами клавиатуры, пока не будет выгружен. 
 */ 
 
#include <linux/init.h> 
#include <linux/kd.h> /* Для KDSETLED. */ 
#include <linux/module.h> 
#include <linux/tty.h> /* Для tty_struct. */ 
#include <linux/vt.h> /* Для MAX_NR_CONSOLES. */ 
#include <linux/vt_kern.h> /* Для fg_console. */ 
#include <linux/console_struct.h> /* Для vc_cons. */ 
 
MODULE_DESCRIPTION("Example module illustrating the use of Keyboard LEDs."); 
 
static struct timer_list my_timer; 
static struct tty_driver *my_driver; 
static unsigned long kbledstatus = 0; 
 
#define BLINK_DELAY HZ / 5 
#define ALL_LEDS_ON 0x07 
#define RESTORE_LEDS 0xFF 
 
/* Функция my_timer_func периодически мигает светодиодами, 
 * вызывая для драйвера клавиатуры команду управления вводом-выводом  
 * KDSETLED. Дополнительную информацию по командам ввода-вывода 
 * смотрите в функции vt_ioctl() файла drivers/tty/vt/vt_ioctl.c. 
 * 
 * Аргумент KDSETLED попеременно устанавливается то на 7 (что приводит к 
 * активации режима LED_SHOW_IOCTL и загоранию всех светодиодов), то на 
 * 0xFF (любое значение выше 7 переключает режим обратно на 
 * LED_SHOW_FLAGS, в результате чего светодиоды отображают фактический 
 * статус клавиатуры). Подробности смотрите в функции setledstate() файла 
 * drivers/tty/vt/keyboard.c.
  */ 
static void my_timer_func(struct timer_list *unused) 
{ 
    struct tty_struct *t = vc_cons[fg_console].d->port.tty; 
 
    if (kbledstatus == ALL_LEDS_ON) 
        kbledstatus = RESTORE_LEDS; 
    else 
        kbledstatus = ALL_LEDS_ON; 
 
    (my_driver->ops->ioctl)(t, KDSETLED, kbledstatus); 
 
    my_timer.expires = jiffies + BLINK_DELAY; 
    add_timer(&my_timer); 
} 
 
static int __init kbleds_init(void) 
{ 
    int i; 
 
    pr_info("kbleds: loadingn"); 
    pr_info("kbleds: fgconsole is %xn", fg_console); 
    for (i = 0; i < MAX_NR_CONSOLES; i++) { 
        if (!vc_cons[i].d) 
            break; 
        pr_info("poet_atkm: console[%i/%i] #%i, tty %pn", i, MAX_NR_CONSOLES, 
                vc_cons[i].d->vc_num, (void *)vc_cons[i].d->port.tty); 
    } 
    pr_info("kbleds: finished scanning consolesn"); 
 
    my_driver = vc_cons[fg_console].d->port.tty->driver; 
    pr_info("kbleds: tty driver magic %xn", my_driver->magic); 
 
    /* Первая настройка таймера мигания светодиодов. */ 
    timer_setup(&my_timer, my_timer_func, 0); 
    my_timer.expires = jiffies + BLINK_DELAY; 
    add_timer(&my_timer); 
 
    return 0; 
} 
 
static void __exit kbleds_cleanup(void) 
{ 
    pr_info("kbleds: unloading...n"); 
    del_timer(&my_timer); 
    (my_driver->ops->ioctl)(vc_cons[fg_console].d->port.tty, KDSETLED, 
                            RESTORE_LEDS); 
} 
 
module_init(kbleds_init); 
module_exit(kbleds_cleanup); 
 
MODULE_LICENSE("GPL");

/* 
 * example_tasklet.c 
 */ 
#include <linux/delay.h> 
#include <linux/interrupt.h> 
#include <linux/kernel.h> 
#include <linux/module.h> 
 
/* Макрос DECLARE_TASKLET_OLD присутствует для совместимости. 
 * См. https://lwn.net/Articles/830964/.
 */ 
#ifndef DECLARE_TASKLET_OLD 
#define DECLARE_TASKLET_OLD(arg1, arg2) DECLARE_TASKLET(arg1, arg2, 0L) 
#endif 
 
static void tasklet_fn(unsigned long data) 
{ 
    pr_info("Example tasklet startsn"); 
    mdelay(5000); 
    pr_info("Example tasklet endsn"); 
} 
 
static DECLARE_TASKLET_OLD(mytask, tasklet_fn); 
 
static int example_tasklet_init(void) 
{ 
    pr_info("tasklet example initn"); 
    tasklet_schedule(&mytask); 
    mdelay(200); 
    pr_info("Example tasklet init continues...n"); 
    return 0; 
} 
 
static void example_tasklet_exit(void) 
{ 
    pr_info("tasklet example exitn"); 
    tasklet_kill(&mytask); 
} 
 
module_init(example_tasklet_init); 
module_exit(example_tasklet_exit); 
 
MODULE_DESCRIPTION("Tasklet example"); 
MODULE_LICENSE("GPL");

/* 
 * sched.c 
 */ 
#include <linux/init.h> 
#include <linux/module.h> 
#include <linux/workqueue.h> 
 
static struct workqueue_struct *queue = NULL; 
static struct work_struct work; 
 
static void work_handler(struct work_struct *data) 
{ 
    pr_info("work handler function.n"); 
} 
 
static int __init sched_init(void) 
{ 
    queue = alloc_workqueue("HELLOWORLD", WQ_UNBOUND, 1); 
    INIT_WORK(&work, work_handler); 
    schedule_work(&work); 
    return 0; 
} 
 
static void __exit sched_exit(void) 
{ 
    destroy_workqueue(queue); 
} 
 
module_init(sched_init); 
module_exit(sched_exit); 
 
MODULE_LICENSE("GPL"); 
MODULE_DESCRIPTION("Workqueue example");