drivers/gpio/kw_gpio.c

   1 /*
   2  * arch/arm/plat-orion/gpio.c
   3  *
   4  * Marvell Orion SoC GPIO handling.
   5  *
   6  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 /*
  10  * Based on (mostly copied from) plat-orion based Linux 2.6 kernel driver.
  11  * Removed orion_gpiochip struct and kernel level irq handling.
  12  *
  13  * Dieter Kiermaier dk-arm-linux@gmx.de
  14  */
  15
  16 #include <common.h>
  17 #include <asm/bitops.h>
  18 #include <asm/io.h>
  19 #include <asm/arch/soc.h>
  20 #include <asm/arch/gpio.h>
  21
  22 static unsigned long gpio_valid_input[BITS_TO_LONGS(GPIO_MAX)];
  23 static unsigned long gpio_valid_output[BITS_TO_LONGS(GPIO_MAX)];
  24
  25 void __set_direction(unsigned pin, int input)
  26 {
  27         u32 u;
  28
  29         u = readl(GPIO_IO_CONF(pin));
  30         if (input)
  31                 u |= 1 << (pin & 31);
  32         else
  33                 u &= ~(1 << (pin & 31));
  34         writel(u, GPIO_IO_CONF(pin));
  35
  36         u = readl(GPIO_IO_CONF(pin));
  37 }
  38
  39 static void __set_level(unsigned pin, int high)
  40 {
  41         u32 u;
  42
  43         u = readl(GPIO_OUT(pin));
  44         if (high)
  45                 u |= 1 << (pin & 31);
  46         else
  47                 u &= ~(1 << (pin & 31));
  48         writel(u, GPIO_OUT(pin));
  49 }
  50
  51 static void __set_blinking(unsigned pin, int blink)
  52 {
  53         u32 u;
  54
  55         u = readl(GPIO_BLINK_EN(pin));
  56         if (blink)
  57                 u |= 1 << (pin & 31);
  58         else
  59                 u &= ~(1 << (pin & 31));
  60         writel(u, GPIO_BLINK_EN(pin));
  61 }
  62
  63 int kw_gpio_is_valid(unsigned pin, int mode)
  64 {
  65         if (pin < GPIO_MAX) {
  66                 if ((mode & GPIO_INPUT_OK) && !test_bit(pin, gpio_valid_input))
  67                         goto err_out;
  68
  69                 if ((mode & GPIO_OUTPUT_OK) && !test_bit(pin, gpio_valid_output))
  70                         goto err_out;
  71                 return 0;
  72         }
  73
  74 err_out:
  75                 printf("%s: invalid GPIO %d\n", __func__, pin);
  76         return 1;
  77 }
  78
  79 void kw_gpio_set_valid(unsigned pin, int mode)
  80 {
  81         if (mode == 1)
  82                 mode = GPIO_INPUT_OK | GPIO_OUTPUT_OK;
  83         if (mode & GPIO_INPUT_OK)
  84                 __set_bit(pin, gpio_valid_input);
  85         else
  86                 __clear_bit(pin, gpio_valid_input);
  87         if (mode & GPIO_OUTPUT_OK)
  88                 __set_bit(pin, gpio_valid_output);
  89         else
  90                 __clear_bit(pin, gpio_valid_output);
  91 }
  92 /*
  93  * GENERIC_GPIO primitives.
  94  */
  95 int kw_gpio_direction_input(unsigned pin)
  96 {
  97         if (kw_gpio_is_valid(pin, GPIO_INPUT_OK) != 0)
  98                 return 1;
  99
 100         /* Configure GPIO direction. */
 101         __set_direction(pin, 1);
 102
 103         return 0;
 104 }
 105
 106 int kw_gpio_direction_output(unsigned pin, int value)
 107 {
 108         if (kw_gpio_is_valid(pin, GPIO_OUTPUT_OK) != 0)
 109         {
 110                 printf("%s: invalid GPIO %d\n", __func__, pin);
 111                 return 1;
 112         }
 113
 114         __set_blinking(pin, 0);
 115
 116         /* Configure GPIO output value. */
 117         __set_level(pin, value);
 118
 119         /* Configure GPIO direction. */
 120         __set_direction(pin, 0);
 121
 122         return 0;
 123 }
 124
 125 int kw_gpio_get_value(unsigned pin)
 126 {
 127         int val;
 128
 129         if (readl(GPIO_IO_CONF(pin)) & (1 << (pin & 31)))
 130                 val = readl(GPIO_DATA_IN(pin)) ^ readl(GPIO_IN_POL(pin));
 131         else
 132                 val = readl(GPIO_OUT(pin));
 133
 134         return (val >> (pin & 31)) & 1;
 135 }
 136
 137 void kw_gpio_set_value(unsigned pin, int value)
 138 {
 139         /* Configure GPIO output value. */
 140         __set_level(pin, value);
 141 }
 142
 143 void kw_gpio_set_blink(unsigned pin, int blink)
 144 {
 145         /* Set output value to zero. */
 146         __set_level(pin, 0);
 147
 148         /* Set blinking. */
 149         __set_blinking(pin, blink);
 150 }