hc
2024-08-16 a24a44ff9ca902811b99aa9663d697cf452e08ef
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
/* SPDX-License-Identifier: GPL-2.0-only */
/*
 * Coldfire generic GPIO support
 *
 * (C) Copyright 2009, Steven King <sfking@fdwdc.com>
*/
 
#ifndef coldfire_gpio_h
#define coldfire_gpio_h
 
#include <linux/io.h>
#include <asm/coldfire.h>
#include <asm/mcfsim.h>
#include <asm/mcfgpio.h>
/*
 * The Generic GPIO functions
 *
 * If the gpio is a compile time constant and is one of the Coldfire gpios,
 * use the inline version, otherwise dispatch thru gpiolib.
 */
 
static inline int gpio_get_value(unsigned gpio)
{
   if (__builtin_constant_p(gpio) && gpio < MCFGPIO_PIN_MAX)
       return mcfgpio_read(__mcfgpio_ppdr(gpio)) & mcfgpio_bit(gpio);
   else
       return __gpio_get_value(gpio);
}
 
static inline void gpio_set_value(unsigned gpio, int value)
{
   if (__builtin_constant_p(gpio) && gpio < MCFGPIO_PIN_MAX) {
       if (gpio < MCFGPIO_SCR_START) {
           unsigned long flags;
           MCFGPIO_PORTTYPE data;
 
           local_irq_save(flags);
           data = mcfgpio_read(__mcfgpio_podr(gpio));
           if (value)
               data |= mcfgpio_bit(gpio);
           else
               data &= ~mcfgpio_bit(gpio);
           mcfgpio_write(data, __mcfgpio_podr(gpio));
           local_irq_restore(flags);
       } else {
           if (value)
               mcfgpio_write(mcfgpio_bit(gpio),
                       MCFGPIO_SETR_PORT(gpio));
           else
               mcfgpio_write(~mcfgpio_bit(gpio),
                       MCFGPIO_CLRR_PORT(gpio));
       }
   } else
       __gpio_set_value(gpio, value);
}
 
static inline int gpio_to_irq(unsigned gpio)
{
#if defined(MCFGPIO_IRQ_MIN)
   if ((gpio >= MCFGPIO_IRQ_MIN) && (gpio < MCFGPIO_IRQ_MAX))
#else
   if (gpio < MCFGPIO_IRQ_MAX)
#endif
       return gpio + MCFGPIO_IRQ_VECBASE;
   else
       return __gpio_to_irq(gpio);
}
 
static inline int irq_to_gpio(unsigned irq)
{
   return (irq >= MCFGPIO_IRQ_VECBASE &&
       irq < (MCFGPIO_IRQ_VECBASE + MCFGPIO_IRQ_MAX)) ?
       irq - MCFGPIO_IRQ_VECBASE : -ENXIO;
}
 
static inline int gpio_cansleep(unsigned gpio)
{
   return gpio < MCFGPIO_PIN_MAX ? 0 : __gpio_cansleep(gpio);
}
 
#ifndef CONFIG_GPIOLIB
static inline int gpio_request_one(unsigned gpio, unsigned long flags, const char *label)
{
   int err;
 
   err = gpio_request(gpio, label);
   if (err)
       return err;
 
   if (flags & GPIOF_DIR_IN)
       err = gpio_direction_input(gpio);
   else
       err = gpio_direction_output(gpio,
           (flags & GPIOF_INIT_HIGH) ? 1 : 0);
 
   if (err)
       gpio_free(gpio);
 
   return err;
}
#endif /* !CONFIG_GPIOLIB */
#endif