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
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
#include <common.h>
#include <gpio.h>
#include <errno.h>
static LIST_HEAD(chip_list);
static struct gpio_chip *gpio_desc[ARCH_NR_GPIOS];
void gpio_set_value(unsigned gpio, int value)
{
struct gpio_chip *chip = gpio_desc[gpio];
if (!gpio_is_valid(gpio))
return;
if (!chip)
return;
if (!chip->ops->set)
return;
chip->ops->set(chip, gpio - chip->base, value);
}
EXPORT_SYMBOL(gpio_set_value);
int gpio_get_value(unsigned gpio)
{
struct gpio_chip *chip = gpio_desc[gpio];
if (!gpio_is_valid(gpio))
return -EINVAL;
if (!chip)
return -ENODEV;
if (!chip->ops->get)
return -ENOSYS;
return chip->ops->get(chip, gpio - chip->base);
}
EXPORT_SYMBOL(gpio_get_value);
int gpio_direction_output(unsigned gpio, int value)
{
struct gpio_chip *chip = gpio_desc[gpio];
if (!gpio_is_valid(gpio))
return -EINVAL;
if (!chip)
return -ENODEV;
if (!chip->ops->direction_output)
return -ENOSYS;
return chip->ops->direction_output(chip, gpio - chip->base, value);
}
EXPORT_SYMBOL(gpio_direction_output);
int gpio_direction_input(unsigned gpio)
{
struct gpio_chip *chip = gpio_desc[gpio];
if (!gpio_is_valid(gpio))
return -EINVAL;
if (!chip)
return -ENODEV;
if (!chip->ops->direction_input)
return -ENOSYS;
return chip->ops->direction_input(chip, gpio - chip->base);
}
EXPORT_SYMBOL(gpio_direction_input);
static int gpiochip_find_base(int start, int ngpio)
{
int i;
int spare = 0;
int base = -ENOSPC;
if (start < 0)
start = 0;
for (i = start; i < ARCH_NR_GPIOS; i++) {
struct gpio_chip *chip = gpio_desc[i];
if (!chip) {
spare++;
if (spare == ngpio) {
base = i + 1 - ngpio;
break;
}
} else {
spare = 0;
i += chip->ngpio - 1;
}
}
if (gpio_is_valid(base))
debug("%s: found new base at %d\n", __func__, base);
return base;
}
int gpiochip_add(struct gpio_chip *chip)
{
int base, i;
base = gpiochip_find_base(chip->base, chip->ngpio);
if (base < 0)
return base;
if (chip->base >= 0 && chip->base != base)
return -EBUSY;
chip->base = base;
list_add_tail(&chip->list, &chip_list);
for (i = chip->base; i < chip->base + chip->ngpio; i++)
gpio_desc[i] = chip;
return 0;
}
int gpio_get_num(struct device_d *dev, int gpio)
{
struct gpio_chip *chip;
list_for_each_entry(chip, &chip_list, list) {
if (chip->dev == dev)
return chip->base + gpio;
}
return -ENODEV;
}
|
