Begin work on rust versions of modules
This commit is contained in:
parent
1f2cc50f26
commit
91f8ca7f49
23 changed files with 53 additions and 9 deletions
7
lang_c/01_basic_module/Makefile
Normal file
7
lang_c/01_basic_module/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
22
lang_c/01_basic_module/test_module.c
Normal file
22
lang_c/01_basic_module/test_module.c
Normal file
|
@ -0,0 +1,22 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
|
||||
static int __init basic_module_init(void)
|
||||
{
|
||||
pr_info("Bonjour! Le module est chargé.\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit basic_module_exit(void)
|
||||
{
|
||||
pr_info("Au revoir! Le module est déchargé.\n");
|
||||
}
|
||||
|
||||
module_init(basic_module_init);
|
||||
module_exit(basic_module_exit);
|
||||
|
||||
MODULE_LICENSE("MIT License");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau qui affiche un message");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/02_module_params/Makefile
Normal file
7
lang_c/02_module_params/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
55
lang_c/02_module_params/test_module.c
Normal file
55
lang_c/02_module_params/test_module.c
Normal file
|
@ -0,0 +1,55 @@
|
|||
#include <linux/module.h>
|
||||
#include <linux/kernel.h>
|
||||
|
||||
static short int myshort = 1;
|
||||
static int myint = 420;
|
||||
static long int mylong = 9999;
|
||||
static char *mystring = "blah";
|
||||
static int myintarray[2] = { 420, 420 };
|
||||
static int arr_argc = 0;
|
||||
|
||||
module_param(myshort, short, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);
|
||||
MODULE_PARM_DESC(myshort, "A short integer");
|
||||
|
||||
module_param(myint, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
|
||||
MODULE_PARM_DESC(myint, "An integer");
|
||||
|
||||
module_param(mylong, long, S_IRUSR);
|
||||
MODULE_PARM_DESC(mylong, "A long integer");
|
||||
|
||||
module_param(mystring, charp, 0000);
|
||||
MODULE_PARM_DESC(mystring, "A character string");
|
||||
|
||||
module_param_array(myintarray, int, &arr_argc, 0000);
|
||||
MODULE_PARM_DESC(myintarray, "An array of integers");
|
||||
|
||||
static int __init module_params_init(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
pr_info("myshort: %hd\n", myshort);
|
||||
pr_info("myint: %d\n", myint);
|
||||
pr_info("mylong: %ld\n", mylong);
|
||||
pr_info("mystring: %s\n", mystring);
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(myintarray); i++)
|
||||
pr_info("myintarray[%d] = %d\n", i, myintarray[i]);
|
||||
|
||||
pr_info("%d arguments for myintarray.\n", arr_argc);
|
||||
|
||||
pr_info("Module avec paramètre chargé.\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit module_params_exit(void)
|
||||
{
|
||||
pr_info("Module avec paramètre déchargé.\n");
|
||||
}
|
||||
|
||||
module_init(module_params_init);
|
||||
module_exit(module_params_exit);
|
||||
|
||||
MODULE_LICENSE("MIT License");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau avec paramètre déchargé.");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/03_character_device/Makefile
Normal file
7
lang_c/03_character_device/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
31
lang_c/03_character_device/README.md
Normal file
31
lang_c/03_character_device/README.md
Normal file
|
@ -0,0 +1,31 @@
|
|||
## Additionnal informations
|
||||
|
||||
To test character device, your need create the device.
|
||||
|
||||
Step 1: Get major number of your module device
|
||||
|
||||
```bash
|
||||
cat /proc/devices | grep flodev
|
||||
```
|
||||
|
||||
Step 2: Create device (as root)
|
||||
|
||||
```bash
|
||||
mknod /dev/[wanted name] -c <major_number> 0
|
||||
```
|
||||
|
||||
Exemple (as root):
|
||||
|
||||
```bash
|
||||
cat /proc/devices | grep flodev # => 236 flodev
|
||||
mknod /dev/flodev0 c 236 0
|
||||
echo "Salut" >> /dev/flodev0
|
||||
dmesg | tail # =>
|
||||
# flodev - Ouverture du périphérique
|
||||
# flodev - Message reçu: Salut
|
||||
# flodev - Fermeture du périphérique
|
||||
rm /dev/flodev0
|
||||
```
|
||||
|
||||
|
||||
|
92
lang_c/03_character_device/test_module.c
Normal file
92
lang_c/03_character_device/test_module.c
Normal file
|
@ -0,0 +1,92 @@
|
|||
#include <linux/fs.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/uaccess.h>
|
||||
|
||||
#define DEVICE_NAME "flodev"
|
||||
#define CLASS_NAME "chardrv"
|
||||
|
||||
static int major_number;
|
||||
static char msg[256] = { 0 };
|
||||
static short size_of_msg;
|
||||
static int device_open(struct inode *, struct file *);
|
||||
static int device_release(struct inode *, struct file *);
|
||||
static ssize_t device_read(struct file *, char *, size_t, loff_t *);
|
||||
static ssize_t device_write(struct file *, const char *, size_t, loff_t *);
|
||||
|
||||
static struct file_operations fops = {
|
||||
.read = device_read,
|
||||
.write = device_write,
|
||||
.open = device_open,
|
||||
.release = device_release,
|
||||
};
|
||||
|
||||
static int __init basic_module_init(void)
|
||||
{
|
||||
pr_info("Bonjour! Le module est chargé.\n");
|
||||
major_number = register_chrdev(0, DEVICE_NAME, &fops);
|
||||
if (major_number < 0) {
|
||||
pr_info("Erreur lors de l'enregistrement du périphérique de caractère\n");
|
||||
return major_number;
|
||||
}
|
||||
pr_info("Périphérique de caractère enregistré avec le numéro de majeur %d\n",
|
||||
major_number);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit basic_module_exit(void)
|
||||
{
|
||||
unregister_chrdev(major_number, DEVICE_NAME);
|
||||
pr_info("Au revoir! Le module est déchargé.\n");
|
||||
}
|
||||
|
||||
static int device_open(struct inode *inode, struct file *file)
|
||||
{
|
||||
pr_info("flodev - Ouverture du périphérique\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int device_release(struct inode *inode, struct file *file)
|
||||
{
|
||||
pr_info("flodev - Fermeture du périphérique\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
static ssize_t device_read(struct file *filp, char *buffer, size_t length,
|
||||
loff_t *offset)
|
||||
{
|
||||
int bytes_read = 0;
|
||||
if (*offset >= size_of_msg) {
|
||||
return 0;
|
||||
}
|
||||
if (*offset + length > size_of_msg) {
|
||||
length = size_of_msg - *offset;
|
||||
}
|
||||
if (copy_to_user(buffer, msg + *offset, length)) {
|
||||
return -EFAULT;
|
||||
}
|
||||
*offset += length;
|
||||
bytes_read = length;
|
||||
pr_info("flodev - Lecture de %d bytes\n", bytes_read);
|
||||
return bytes_read;
|
||||
}
|
||||
|
||||
static ssize_t device_write(struct file *filp, const char *buff, size_t len,
|
||||
loff_t *off)
|
||||
{
|
||||
if (copy_from_user(msg, buff, len)) {
|
||||
return -EFAULT;
|
||||
}
|
||||
size_of_msg = len;
|
||||
pr_info("flodev - Message reçu: %s\n", msg);
|
||||
return len;
|
||||
}
|
||||
|
||||
module_init(basic_module_init);
|
||||
module_exit(basic_module_exit);
|
||||
|
||||
MODULE_LICENSE("MIT License");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau avec un périphérique de caractère");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/04_process_monitor/Makefile
Normal file
7
lang_c/04_process_monitor/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
38
lang_c/04_process_monitor/test_module.c
Normal file
38
lang_c/04_process_monitor/test_module.c
Normal file
|
@ -0,0 +1,38 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/sched/signal.h>
|
||||
|
||||
static inline void print_processus_info(void);
|
||||
|
||||
static int __init basic_module_init(void)
|
||||
{
|
||||
pr_info("Bonjour! Le module est chargé.\n");
|
||||
|
||||
print_processus_info();
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit basic_module_exit(void)
|
||||
{
|
||||
pr_info("Au revoir! Le module est déchargé.\n");
|
||||
}
|
||||
|
||||
static inline void print_processus_info(void)
|
||||
{
|
||||
struct task_struct *task;
|
||||
|
||||
for_each_process(task) {
|
||||
pr_info("PID: %d, COMM: %s, ON CPU: %d\n", task->pid,
|
||||
task->comm, task->on_cpu);
|
||||
}
|
||||
}
|
||||
|
||||
module_init(basic_module_init);
|
||||
module_exit(basic_module_exit);
|
||||
|
||||
MODULE_LICENSE("MIT License");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau qui affiche les processus en cours");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/05_packet_filter/Makefile
Normal file
7
lang_c/05_packet_filter/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
49
lang_c/05_packet_filter/test_module.c
Normal file
49
lang_c/05_packet_filter/test_module.c
Normal file
|
@ -0,0 +1,49 @@
|
|||
#include <linux/module.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/netfilter.h>
|
||||
#include <linux/netfilter_ipv4.h>
|
||||
#include <linux/tcp.h>
|
||||
#include <linux/ip.h>
|
||||
|
||||
static struct nf_hook_ops nfho;
|
||||
|
||||
unsigned int hook_func(void *priv, struct sk_buff *skb,
|
||||
const struct nf_hook_state *state)
|
||||
{
|
||||
const struct iphdr *iph = ip_hdr(skb);
|
||||
const struct tcphdr *tcph = tcp_hdr(skb);
|
||||
|
||||
// Filtrer les paquets TCP avec un port source spécifique
|
||||
if (iph->protocol == IPPROTO_TCP && tcph->source == htons(8080)) {
|
||||
pr_info("Paquets filtrés: TCP source port 8080\n");
|
||||
return NF_DROP;
|
||||
}
|
||||
|
||||
return NF_ACCEPT;
|
||||
}
|
||||
|
||||
static int __init packet_filter_init(void)
|
||||
{
|
||||
nfho.hook = hook_func;
|
||||
nfho.hooknum = NF_INET_PRE_ROUTING;
|
||||
nfho.pf = PF_INET;
|
||||
nfho.priority = NF_IP_PRI_FIRST;
|
||||
|
||||
nf_register_net_hook(&init_net, &nfho);
|
||||
pr_info("Module de filtrage de paquets chargé.\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit packet_filter_exit(void)
|
||||
{
|
||||
nf_unregister_net_hook(&init_net, &nfho);
|
||||
pr_info("Module de filtrage de paquets déchargé.\n");
|
||||
}
|
||||
|
||||
module_init(packet_filter_init);
|
||||
module_exit(packet_filter_exit);
|
||||
|
||||
MODULE_LICENSE("MIT License");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau pour filtrer les paquets réseau");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/06_virtual_led_basic/Makefile
Normal file
7
lang_c/06_virtual_led_basic/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
58
lang_c/06_virtual_led_basic/test_module.c
Normal file
58
lang_c/06_virtual_led_basic/test_module.c
Normal file
|
@ -0,0 +1,58 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/leds.h>
|
||||
#include <linux/module.h>
|
||||
|
||||
static void virtual_led_brightness_set(struct led_classdev *led_cdev,
|
||||
enum led_brightness brightness)
|
||||
{
|
||||
pr_info("Luminosité défini sur la LED %s à %d\n", led_cdev->name,
|
||||
brightness);
|
||||
}
|
||||
|
||||
static enum led_brightness
|
||||
virtual_led_brightness_get(struct led_classdev *led_cdev)
|
||||
{
|
||||
pr_info("Luminosité lu sur la LED %s, valeur actuelle: %d\n",
|
||||
led_cdev->name, led_cdev->brightness);
|
||||
return led_cdev->brightness;
|
||||
}
|
||||
|
||||
static struct led_classdev virtual_led = {
|
||||
.name = "flo-led:white:led-0",
|
||||
.color = LED_COLOR_ID_WHITE,
|
||||
.brightness = 0,
|
||||
.max_brightness = 255,
|
||||
.brightness_set = virtual_led_brightness_set,
|
||||
.brightness_set = virtual_led_brightness_get
|
||||
};
|
||||
|
||||
static int __init virtual_led_init(void)
|
||||
{
|
||||
int ret;
|
||||
pr_info("Chargement du module pour la LED virtuelle\n");
|
||||
|
||||
ret = led_classdev_register(NULL, &virtual_led);
|
||||
if (ret < 0) {
|
||||
pr_err("Impossible d'ajouter la LED virtuelle\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
pr_info("La LED virtuelle est ajouté\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit virtual_led_exit(void)
|
||||
{
|
||||
pr_info("Déchargement du module pour la LED virtuelle\n");
|
||||
led_classdev_unregister(&virtual_led);
|
||||
pr_info("La LED virtuelle est bien retiré\n");
|
||||
}
|
||||
|
||||
module_init(virtual_led_init);
|
||||
module_exit(virtual_led_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau qui ajoute une LED virtuelle");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/07_virtual_leds_more_complex/Makefile
Normal file
7
lang_c/07_virtual_leds_more_complex/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
98
lang_c/07_virtual_leds_more_complex/test_module.c
Normal file
98
lang_c/07_virtual_leds_more_complex/test_module.c
Normal file
|
@ -0,0 +1,98 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/leds.h>
|
||||
#include <linux/module.h>
|
||||
|
||||
#define NUM_LEDS 5
|
||||
|
||||
struct flo_device {
|
||||
struct led_classdev *leds[NUM_LEDS];
|
||||
};
|
||||
|
||||
static struct flo_device flo_dev;
|
||||
|
||||
static void virtual_led_brightness_set(struct led_classdev *led_cdev,
|
||||
enum led_brightness brightness)
|
||||
{
|
||||
pr_info("Luminosité défini sur la LED %s à %d\n", led_cdev->name,
|
||||
brightness);
|
||||
}
|
||||
|
||||
static enum led_brightness
|
||||
virtual_led_brightness_get(struct led_classdev *led_cdev)
|
||||
{
|
||||
pr_info("Luminosité lu sur la LED %s, valeur actuelle: %d\n",
|
||||
led_cdev->name, led_cdev->brightness);
|
||||
return led_cdev->brightness;
|
||||
}
|
||||
|
||||
static int __init virtual_led_init(void)
|
||||
{
|
||||
int ret, i;
|
||||
pr_info("Chargement du module pour les LEDs virtuelles\n");
|
||||
|
||||
for (i = 0; i < NUM_LEDS; i++) {
|
||||
struct led_classdev *led =
|
||||
kzalloc(sizeof(struct led_classdev), GFP_KERNEL);
|
||||
if (!led) {
|
||||
pr_err("Échec de l'allocation de mémoire pour la LED %d\n",
|
||||
i);
|
||||
ret = -ENOMEM;
|
||||
goto fail;
|
||||
}
|
||||
|
||||
led->name =
|
||||
kasprintf(GFP_KERNEL, "flo-led:white:flo-%d", i + 1);
|
||||
led->color = LED_COLOR_ID_WHITE;
|
||||
led->brightness = 0;
|
||||
led->max_brightness = 255;
|
||||
led->brightness_set = virtual_led_brightness_set;
|
||||
led->brightness_get = virtual_led_brightness_get;
|
||||
|
||||
ret = led_classdev_register(NULL, led);
|
||||
if (ret < 0) {
|
||||
pr_err("Impossible d'ajouter la LED virtuelle %d\n", i);
|
||||
kfree(led->name);
|
||||
kfree(led);
|
||||
goto fail;
|
||||
}
|
||||
|
||||
flo_dev.leds[i] = led;
|
||||
}
|
||||
|
||||
pr_info("Les LEDs virtuelles sont ajoutées\n");
|
||||
return 0;
|
||||
|
||||
fail:
|
||||
for (i--; i >= 0; i--) {
|
||||
led_classdev_unregister(flo_dev.leds[i]);
|
||||
kfree(flo_dev.leds[i]->name);
|
||||
kfree(flo_dev.leds[i]);
|
||||
}
|
||||
pr_err("Les LEDs virtuelles n'ont pas pu être ajoutées\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void __exit virtual_led_exit(void)
|
||||
{
|
||||
int i;
|
||||
pr_info("Déchargement du module pour les LEDs virtuelles\n");
|
||||
|
||||
for (i = 0; i < NUM_LEDS; i++) {
|
||||
if (flo_dev.leds[i]) {
|
||||
led_classdev_unregister(flo_dev.leds[i]);
|
||||
kfree(flo_dev.leds[i]->name);
|
||||
kfree(flo_dev.leds[i]);
|
||||
}
|
||||
}
|
||||
|
||||
pr_info("Les LEDs virtuelles sont bien retirées\n");
|
||||
}
|
||||
|
||||
module_init(virtual_led_init);
|
||||
module_exit(virtual_led_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau qui ajoute des LEDs virtuelles");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/08_gpio_pin_rpi3/Makefile
Normal file
7
lang_c/08_gpio_pin_rpi3/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
71
lang_c/08_gpio_pin_rpi3/test_module.c
Normal file
71
lang_c/08_gpio_pin_rpi3/test_module.c
Normal file
|
@ -0,0 +1,71 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
|
||||
// gpiochip0: GPIOs 512-565, parent: platform/3f200000.gpio, pinctrl-bcm2835
|
||||
// From /sys/kernel/debug/gpio
|
||||
#define RPI3_BCM2835_GPIO_OFFSET 512
|
||||
#define BCM_TO_LINUX_GPIO(bcm) (RPI3_BCM2835_GPIO_OFFSET + (bcm))
|
||||
|
||||
static int gpio_pin = -1;
|
||||
module_param(gpio_pin, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
|
||||
MODULE_PARM_DESC(gpio_pin, "BCM GPIO pin number (e.g., 17)");
|
||||
|
||||
struct gpio_pin_rpi3 {
|
||||
int linux_gpio;
|
||||
int bcm_gpio;
|
||||
struct gpio_desc *desc;
|
||||
};
|
||||
|
||||
static struct gpio_pin_rpi3 pin;
|
||||
|
||||
static int __init gpio_pin_rpi3_init(void)
|
||||
{
|
||||
if (gpio_pin < 0) {
|
||||
pr_err("gpio_pin_rpi3: You must specify 'gpio_pin' (e.g., gpio_pin=17)\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
pin.bcm_gpio = gpio_pin;
|
||||
pin.linux_gpio = BCM_TO_LINUX_GPIO(pin.bcm_gpio);
|
||||
|
||||
// Récupération du descripteur GPIO à partir du numéro Globale Linux
|
||||
pin.desc = gpio_to_desc(pin.linux_gpio);
|
||||
if (!pin.desc) {
|
||||
pr_err("gpio_pin_rpi3: Le GPIO %d (BCM %d) non trouvé\n",
|
||||
pin.linux_gpio, pin.bcm_gpio);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
// Réclame le PIN GPIO
|
||||
if (gpiod_direction_output(pin.desc, 0)) {
|
||||
pr_err("gpio_pin_rpi3: Impossible de configurer le GPIO %d\n",
|
||||
pin.linux_gpio);
|
||||
gpiod_put(pin.desc);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
// Allume la LED
|
||||
gpiod_set_value(pin.desc, 1);
|
||||
pr_info("gpio_pin_rpi3: GPIO %d (BCM %d) activé (LED ON)\n",
|
||||
pin.linux_gpio, pin.bcm_gpio);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit gpio_pin_rpi3_exit(void)
|
||||
{
|
||||
// Turn LED off and release GPIO
|
||||
gpiod_set_value(pin.desc, 0);
|
||||
gpiod_put(pin.desc);
|
||||
pr_info("gpio_pin_rpi3: GPIO %d (BCM %d) libéré (LED OFF)\n",
|
||||
pin.linux_gpio, pin.bcm_gpio);
|
||||
}
|
||||
|
||||
module_init(gpio_pin_rpi3_init);
|
||||
module_exit(gpio_pin_rpi3_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION("Un module noyau pour utiliser un PIN GPIO d'une RPI");
|
||||
MODULE_VERSION("1.0");
|
7
lang_c/09_gpio_led_rpi3/Makefile
Normal file
7
lang_c/09_gpio_led_rpi3/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
obj-m += test_module.o
|
||||
|
||||
all:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) modules
|
||||
|
||||
clean:
|
||||
make -C $(LINUX_MODULES_FOLDER)/build M=$(PWD) clean
|
153
lang_c/09_gpio_led_rpi3/test_module.c
Normal file
153
lang_c/09_gpio_led_rpi3/test_module.c
Normal file
|
@ -0,0 +1,153 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/leds.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
|
||||
// gpiochip0: GPIOs 512-565, parent: platform/3f200000.gpio, pinctrl-bcm2835
|
||||
// From /sys/kernel/debug/gpio
|
||||
#define RPI3_BCM2835_GPIO_OFFSET 512
|
||||
#define BCM_TO_LINUX_GPIO(bcm) (RPI3_BCM2835_GPIO_OFFSET + (bcm))
|
||||
|
||||
static int gpio_pin = -1;
|
||||
module_param(gpio_pin, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
|
||||
MODULE_PARM_DESC(gpio_pin, "BCM GPIO pin number (e.g., 17)");
|
||||
|
||||
struct gpio_led_rpi3 {
|
||||
int linux_gpio;
|
||||
int bcm_gpio;
|
||||
struct gpio_desc *desc;
|
||||
struct led_classdev *led;
|
||||
};
|
||||
|
||||
static struct gpio_led_rpi3 pin;
|
||||
|
||||
static void gpio_led_rpi3_brightness_set(struct led_classdev *led_cdev,
|
||||
enum led_brightness brightness)
|
||||
{
|
||||
pr_info("gpio_led_rpi3: Luminosité défini sur la LED %s à %d\n",
|
||||
led_cdev->name, brightness);
|
||||
|
||||
if (brightness < 0 || brightness > 1) {
|
||||
pr_err("gpio_led_rpi3: Valeur incorrecte");
|
||||
return;
|
||||
}
|
||||
|
||||
// Applique la nouvelle valeur à la LED
|
||||
gpiod_set_value(pin.desc, brightness);
|
||||
pr_info("gpio_pin_rpi3: GPIO %d (BCM %d) défini à %d\n", pin.linux_gpio,
|
||||
pin.bcm_gpio, brightness);
|
||||
}
|
||||
|
||||
static enum led_brightness
|
||||
gpio_led_rpi3_brightness_get(struct led_classdev *led_cdev)
|
||||
{
|
||||
pr_info("Luminosité lu sur la LED %s, valeur actuelle: %d\n",
|
||||
led_cdev->name, led_cdev->brightness);
|
||||
return led_cdev->brightness;
|
||||
}
|
||||
|
||||
static int register_rpi3_gpio_pin(void)
|
||||
{
|
||||
if (gpio_pin < 0) {
|
||||
pr_err("gpio_led_rpi3: You must specify 'gpio_pin' (e.g., gpio_pin=17)\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
pin.bcm_gpio = gpio_pin;
|
||||
pin.linux_gpio = BCM_TO_LINUX_GPIO(pin.bcm_gpio);
|
||||
|
||||
// Récupération du descripteur GPIO à partir du numéro Globale Linux
|
||||
pin.desc = gpio_to_desc(pin.linux_gpio);
|
||||
if (!pin.desc) {
|
||||
pr_err("gpio_led_rpi3: Le GPIO %d (BCM %d) non trouvé\n",
|
||||
pin.linux_gpio, pin.bcm_gpio);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
// Réclame le PIN GPIO
|
||||
if (gpiod_direction_output(pin.desc, 0)) {
|
||||
pr_err("gpio_led_rpi3: Impossible de configurer le GPIO %d\n",
|
||||
pin.linux_gpio);
|
||||
gpiod_put(pin.desc);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
// Réinitialise la LED
|
||||
gpiod_set_value(pin.desc, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void unregister_rpi3_gpio_pin(void)
|
||||
{
|
||||
// Turn LED off and release GPIO
|
||||
gpiod_set_value(pin.desc, 0);
|
||||
gpiod_put(pin.desc);
|
||||
pr_info("gpio_led_rpi3: GPIO %d (BCM %d) libéré (LED OFF)\n",
|
||||
pin.linux_gpio, pin.bcm_gpio);
|
||||
}
|
||||
|
||||
static int register_rpi3_led(void)
|
||||
{
|
||||
pin.led = kzalloc(sizeof(struct led_classdev), GFP_KERNEL);
|
||||
if (!pin.led) {
|
||||
pr_err("Échec de l'allocation de mémoire pour la LED virtuelle\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
pin.led->name =
|
||||
kasprintf(GFP_KERNEL, "rpi3-led:white:gpio-%d", pin.bcm_gpio);
|
||||
pin.led->color = LED_COLOR_ID_WHITE;
|
||||
pin.led->brightness = 0;
|
||||
pin.led->max_brightness = 1;
|
||||
pin.led->brightness_set = gpio_led_rpi3_brightness_set;
|
||||
pin.led->brightness_get = gpio_led_rpi3_brightness_get;
|
||||
|
||||
int ret = led_classdev_register(NULL, pin.led);
|
||||
if (ret < 0) {
|
||||
kfree(pin.led->name);
|
||||
kfree(pin.led);
|
||||
pr_err("Impossible d'ajouter la LED virtuelle\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void unregister_rpi3_led(void)
|
||||
{
|
||||
led_classdev_unregister(pin.led);
|
||||
kfree(pin.led->name);
|
||||
kfree(pin.led);
|
||||
}
|
||||
|
||||
static int __init gpio_led_rpi3_init(void)
|
||||
{
|
||||
int ret = register_rpi3_gpio_pin();
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = register_rpi3_led();
|
||||
if (ret != 0) {
|
||||
unregister_rpi3_gpio_pin();
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit gpio_led_rpi3_exit(void)
|
||||
{
|
||||
unregister_rpi3_led();
|
||||
unregister_rpi3_gpio_pin();
|
||||
}
|
||||
|
||||
module_init(gpio_led_rpi3_init);
|
||||
module_exit(gpio_led_rpi3_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Florian RICHER <florian.richer@protonmail.com>");
|
||||
MODULE_DESCRIPTION(
|
||||
"Un module noyau pour utiliser un PIN GPIO d'une RPI en tant que LED");
|
||||
MODULE_VERSION("1.0");
|
Loading…
Add table
Add a link
Reference in a new issue