-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathhomework1.c
101 lines (85 loc) · 2.54 KB
/
homework1.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/cdev.h>
#include <linux/device.h>
#include <linux/uaccess.h>
#include <linux/io.h>
#include <linux/delay.h>
MODULE_AUTHOR("Sakurai Maki and Ryuichi Ueda");
MODULE_DESCRIPTION("driver for GPIO control");
MODULE_LICENSE("GPL");
MODULE_VERSION("0.0.2");
static dev_t dev;
static struct cdev cdv;
static struct class *cls = NULL;
static volatile u32 *gpio_base = NULL;
static ssize_t gpio_write(struct file* filp, const char* buf, size_t count, loff_t* pos)
{
char c;
if(copy_from_user(&c,buf,sizeof(char)))
return -EFAULT;
if(c == 'e'){ //esa
msleep(2000);
gpio_base[7] = 1 << 25; //ON
msleep(1500);
gpio_base[10] = 1 <<25; //OFF
c = '0';
}else if(c == 'n'){ //nokori
msleep(2000);
gpio_base[7] = 1 << 25; //ON
msleep(300);
gpio_base[10] = 1 <<25; //OFF
msleep(300);
gpio_base[7] = 1 << 25; //ON
msleep(300);
gpio_base[10] = 1 <<25; //OFF
msleep(300);
gpio_base[7] = 1 << 25; //ON
msleep(300);
gpio_base[10] = 1 <<25; //OFF
c = '0';
}
printk(KERN_INFO "gpio_write is called\n");
return 1;
}
static struct file_operations gpio_fops = {
.owner = THIS_MODULE,
.write = gpio_write
};
static int __init init_mod(void){
int retval;
retval = alloc_chrdev_region(&dev, 0, 1, "homework1");
if(retval < 0){
printk(KERN_ERR "alloc_chrdev_region failed. \n");
return retval;
}
printk(KERN_INFO "%s is loaded. major: %d\n", __FILE__,MAJOR(dev));
cdev_init(&cdv, &gpio_fops);
retval = cdev_add(&cdv, dev, 1);
if(retval < 0){
printk(KERN_ERR "cdev_add failed. major:%d, minor:%d",MAJOR(dev),MINOR(dev));
return retval;
}
cls = class_create(THIS_MODULE, "homework1");
if(IS_ERR(cls)){
printk(KERN_ERR "class_create failed. \n");
return PTR_ERR(cls);
}
device_create(cls, NULL, dev, NULL, "homework1%d", MINOR(dev));
gpio_base = ioremap_nocache(0xfe200000,0xA0);
const u32 led = 25;
const u32 index = led/10;
const u32 shift = (led%10)*3;
const u32 mask = ~(0x7 << shift);
gpio_base[index] = (gpio_base[index] & mask) | (0x1 << shift);
return 0;
}
static void __exit cleanup_mod(void){
cdev_del(&cdv);
device_destroy(cls, dev);
class_destroy(cls);
unregister_chrdev_region(dev, 1);
printk(KERN_INFO "%s is unloaded. major: %d\n", __FILE__,MAJOR(dev));
}
module_init(init_mod);
module_exit(cleanup_mod);