projects / J-u-boot.git / blame
| Commit | Line | Data |
|---|---|---|
| ec164410 DK |
1 | /* |
| 2 | * arch/arm/plat-orion/gpio.c | |
| 3 | * | |
| 4 | * Marvell Orion SoC GPIO handling. | |
| 5 | * | |
| 1a459660 | 6 | * SPDX-License-Identifier: GPL-2.0+ |
| ec164410 DK |
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 [email protected] | |
| 14 | */ | |
| 15 | ||
| 16 | #include <common.h> | |
| 17 | #include <asm/bitops.h> | |
| a7efd719 | 18 | #include <asm/io.h> |
| 3dc23f78 | 19 | #include <asm/arch/soc.h> |
| ec164410 DK |
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 | ||
| 2115d89d | 39 | static void __set_level(unsigned pin, int high) |
| ec164410 DK |
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 | ||
| 2115d89d | 51 | static void __set_blinking(unsigned pin, int blink) |
| ec164410 DK |
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 | { | |
| e5afdf58 | 97 | if (kw_gpio_is_valid(pin, GPIO_INPUT_OK) != 0) |
| ec164410 DK |
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 | } |