hi6220_gpio.c 2.0 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2015 Linaro
  4. * Peter Griffin <peter.griffin@linaro.org>
  5. */
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <asm/gpio.h>
  9. #include <asm/io.h>
  10. #include <errno.h>
  11. #include <linux/bitops.h>
  12. static int hi6220_gpio_direction_input(struct udevice *dev, unsigned int gpio)
  13. {
  14. struct gpio_bank *bank = dev_get_priv(dev);
  15. u8 data;
  16. data = readb(bank->base + HI6220_GPIO_DIR);
  17. data &= ~(1 << gpio);
  18. writeb(data, bank->base + HI6220_GPIO_DIR);
  19. return 0;
  20. }
  21. static int hi6220_gpio_set_value(struct udevice *dev, unsigned gpio,
  22. int value)
  23. {
  24. struct gpio_bank *bank = dev_get_priv(dev);
  25. writeb(!!value << gpio, bank->base + (BIT(gpio + 2)));
  26. return 0;
  27. }
  28. static int hi6220_gpio_direction_output(struct udevice *dev, unsigned gpio,
  29. int value)
  30. {
  31. struct gpio_bank *bank = dev_get_priv(dev);
  32. u8 data;
  33. data = readb(bank->base + HI6220_GPIO_DIR);
  34. data |= 1 << gpio;
  35. writeb(data, bank->base + HI6220_GPIO_DIR);
  36. hi6220_gpio_set_value(dev, gpio, value);
  37. return 0;
  38. }
  39. static int hi6220_gpio_get_value(struct udevice *dev, unsigned gpio)
  40. {
  41. struct gpio_bank *bank = dev_get_priv(dev);
  42. return !!readb(bank->base + (BIT(gpio + 2)));
  43. }
  44. static const struct dm_gpio_ops gpio_hi6220_ops = {
  45. .direction_input = hi6220_gpio_direction_input,
  46. .direction_output = hi6220_gpio_direction_output,
  47. .get_value = hi6220_gpio_get_value,
  48. .set_value = hi6220_gpio_set_value,
  49. };
  50. static int hi6220_gpio_probe(struct udevice *dev)
  51. {
  52. struct gpio_bank *bank = dev_get_priv(dev);
  53. struct hikey_gpio_platdata *plat = dev_get_platdata(dev);
  54. struct gpio_dev_priv *uc_priv = dev->uclass_priv;
  55. char name[18], *str;
  56. sprintf(name, "GPIO%d_", plat->bank_index);
  57. str = strdup(name);
  58. if (!str)
  59. return -ENOMEM;
  60. uc_priv->bank_name = str;
  61. uc_priv->gpio_count = HI6220_GPIO_PER_BANK;
  62. bank->base = (u8 *)plat->base;
  63. return 0;
  64. }
  65. U_BOOT_DRIVER(gpio_hi6220) = {
  66. .name = "gpio_hi6220",
  67. .id = UCLASS_GPIO,
  68. .ops = &gpio_hi6220_ops,
  69. .probe = hi6220_gpio_probe,
  70. .priv_auto_alloc_size = sizeof(struct gpio_bank),
  71. };