blob: 36f4fbfa4704fafe35e75352aed70fef6d429349 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Simon Glassc2012cb2017-07-25 08:30:11 -06002/*
3 * Copyright (C) 2014 NVIDIA Corporation
Simon Glassc2012cb2017-07-25 08:30:11 -06004 */
5
6#include <common.h>
7#include <dm.h>
8#include <asm/gpio.h>
9#include <power/as3722.h>
10#include <power/pmic.h>
11
12#define NUM_GPIOS 8
13
14int as3722_gpio_configure(struct udevice *pmic, unsigned int gpio,
15 unsigned long flags)
16{
17 u8 value = 0;
18 int err;
19
20 if (flags & AS3722_GPIO_OUTPUT_VDDH)
21 value |= AS3722_GPIO_CONTROL_MODE_OUTPUT_VDDH;
22
23 if (flags & AS3722_GPIO_INVERT)
24 value |= AS3722_GPIO_CONTROL_INVERT;
25
26 err = pmic_reg_write(pmic, AS3722_GPIO_CONTROL(gpio), value);
27 if (err) {
Masahiro Yamada9b643e32017-09-16 14:10:41 +090028 pr_err("failed to configure GPIO#%u: %d", gpio, err);
Simon Glassc2012cb2017-07-25 08:30:11 -060029 return err;
30 }
31
32 return 0;
33}
34
35static int as3722_gpio_set_value(struct udevice *dev, unsigned int gpio,
36 int level)
37{
38 struct udevice *pmic = dev_get_parent(dev);
39 const char *l;
40 u8 value;
41 int err;
42
43 if (gpio >= NUM_GPIOS)
44 return -EINVAL;
45
46 err = pmic_reg_read(pmic, AS3722_GPIO_SIGNAL_OUT);
47 if (err < 0) {
Masahiro Yamada9b643e32017-09-16 14:10:41 +090048 pr_err("failed to read GPIO signal out register: %d", err);
Simon Glassc2012cb2017-07-25 08:30:11 -060049 return err;
50 }
51 value = err;
52
53 if (level == 0) {
54 value &= ~(1 << gpio);
55 l = "low";
56 } else {
57 value |= 1 << gpio;
58 l = "high";
59 }
60
61 err = pmic_reg_write(pmic, AS3722_GPIO_SIGNAL_OUT, value);
62 if (err) {
Masahiro Yamada9b643e32017-09-16 14:10:41 +090063 pr_err("failed to set GPIO#%u %s: %d", gpio, l, err);
Simon Glassc2012cb2017-07-25 08:30:11 -060064 return err;
65 }
66
67 return 0;
68}
69
70int as3722_gpio_direction_output(struct udevice *dev, unsigned int gpio,
71 int value)
72{
73 struct udevice *pmic = dev_get_parent(dev);
74 int err;
75
76 if (gpio > 7)
77 return -EINVAL;
78
79 if (value == 0)
80 value = AS3722_GPIO_CONTROL_MODE_OUTPUT_VDDL;
81 else
82 value = AS3722_GPIO_CONTROL_MODE_OUTPUT_VDDH;
83
84 err = pmic_reg_write(pmic, AS3722_GPIO_CONTROL(gpio), value);
85 if (err) {
Masahiro Yamada9b643e32017-09-16 14:10:41 +090086 pr_err("failed to configure GPIO#%u as output: %d", gpio, err);
Simon Glassc2012cb2017-07-25 08:30:11 -060087 return err;
88 }
89
90 err = as3722_gpio_set_value(pmic, gpio, value);
91 if (err < 0) {
Masahiro Yamada9b643e32017-09-16 14:10:41 +090092 pr_err("failed to set GPIO#%u high: %d", gpio, err);
Simon Glassc2012cb2017-07-25 08:30:11 -060093 return err;
94 }
95
96 return 0;
97}
98
99static int as3722_gpio_probe(struct udevice *dev)
100{
101 struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
102
103 uc_priv->gpio_count = NUM_GPIOS;
104 uc_priv->bank_name = "as3722_";
105
106 return 0;
107}
108
109static const struct dm_gpio_ops gpio_as3722_ops = {
110 .direction_output = as3722_gpio_direction_output,
111 .set_value = as3722_gpio_set_value,
112};
113
114U_BOOT_DRIVER(gpio_as3722) = {
115 .name = "gpio_as3722",
116 .id = UCLASS_GPIO,
117 .ops = &gpio_as3722_ops,
118 .probe = as3722_gpio_probe,
119};