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#include "priv.h"
26
27struct nv50_gpio_priv {
28 struct nouveau_gpio base;
29};
30
31static void
32nv50_gpio_reset(struct nouveau_gpio *gpio, u8 match)
33{
34 struct nouveau_bios *bios = nouveau_bios(gpio);
35 struct nv50_gpio_priv *priv = (void *)gpio;
36 u8 ver, len;
37 u16 entry;
38 int ent = -1;
39
40 while ((entry = dcb_gpio_entry(bios, 0, ++ent, &ver, &len))) {
41 static const u32 regs[] = { 0xe100, 0xe28c };
42 u32 data = nv_ro32(bios, entry);
43 u8 line = (data & 0x0000001f);
44 u8 func = (data & 0x0000ff00) >> 8;
45 u8 defs = !!(data & 0x01000000);
46 u8 unk0 = !!(data & 0x02000000);
47 u8 unk1 = !!(data & 0x04000000);
48 u32 val = (unk1 << 16) | unk0;
49 u32 reg = regs[line >> 4]; line &= 0x0f;
50
51 if ( func == DCB_GPIO_UNUSED ||
52 (match != DCB_GPIO_UNUSED && match != func))
53 continue;
54
55 gpio->set(gpio, 0, func, line, defs);
56
57 nv_mask(priv, reg, 0x00010001 << line, val << line);
58 }
59}
60
61static int
62nv50_gpio_location(int line, u32 *reg, u32 *shift)
63{
64 const u32 nv50_gpio_reg[4] = { 0xe104, 0xe108, 0xe280, 0xe284 };
65
66 if (line >= 32)
67 return -EINVAL;
68
69 *reg = nv50_gpio_reg[line >> 3];
70 *shift = (line & 7) << 2;
71 return 0;
72}
73
74static int
75nv50_gpio_drive(struct nouveau_gpio *gpio, int line, int dir, int out)
76{
77 u32 reg, shift;
78
79 if (nv50_gpio_location(line, ®, &shift))
80 return -EINVAL;
81
82 nv_mask(gpio, reg, 7 << shift, (((dir ^ 1) << 1) | out) << shift);
83 return 0;
84}
85
86static int
87nv50_gpio_sense(struct nouveau_gpio *gpio, int line)
88{
89 u32 reg, shift;
90
91 if (nv50_gpio_location(line, ®, &shift))
92 return -EINVAL;
93
94 return !!(nv_rd32(gpio, reg) & (4 << shift));
95}
96
97void
98nv50_gpio_intr(struct nouveau_subdev *subdev)
99{
100 struct nv50_gpio_priv *priv = (void *)subdev;
101 u32 intr0, intr1 = 0;
102 u32 hi, lo;
103 int i;
104
105 intr0 = nv_rd32(priv, 0xe054) & nv_rd32(priv, 0xe050);
106 if (nv_device(priv)->chipset >= 0x90)
107 intr1 = nv_rd32(priv, 0xe074) & nv_rd32(priv, 0xe070);
108
109 hi = (intr0 & 0x0000ffff) | (intr1 << 16);
110 lo = (intr0 >> 16) | (intr1 & 0xffff0000);
111
112 for (i = 0; (hi | lo) && i < 32; i++) {
113 if ((hi | lo) & (1 << i))
114 nouveau_event_trigger(priv->base.events, i);
115 }
116
117 nv_wr32(priv, 0xe054, intr0);
118 if (nv_device(priv)->chipset >= 0x90)
119 nv_wr32(priv, 0xe074, intr1);
120}
121
122void
123nv50_gpio_intr_enable(struct nouveau_event *event, int line)
124{
125 const u32 addr = line < 16 ? 0xe050 : 0xe070;
126 const u32 mask = 0x00010001 << (line & 0xf);
127 nv_wr32(event->priv, addr + 0x04, mask);
128 nv_mask(event->priv, addr + 0x00, mask, mask);
129}
130
131void
132nv50_gpio_intr_disable(struct nouveau_event *event, int line)
133{
134 const u32 addr = line < 16 ? 0xe050 : 0xe070;
135 const u32 mask = 0x00010001 << (line & 0xf);
136 nv_wr32(event->priv, addr + 0x04, mask);
137 nv_mask(event->priv, addr + 0x00, mask, 0x00000000);
138}
139
140static int
141nv50_gpio_ctor(struct nouveau_object *parent, struct nouveau_object *engine,
142 struct nouveau_oclass *oclass, void *data, u32 size,
143 struct nouveau_object **pobject)
144{
145 struct nv50_gpio_priv *priv;
146 int ret;
147
148 ret = nouveau_gpio_create(parent, engine, oclass,
149 nv_device(parent)->chipset >= 0x90 ? 32 : 16,
150 &priv);
151 *pobject = nv_object(priv);
152 if (ret)
153 return ret;
154
155 priv->base.reset = nv50_gpio_reset;
156 priv->base.drive = nv50_gpio_drive;
157 priv->base.sense = nv50_gpio_sense;
158 priv->base.events->priv = priv;
159 priv->base.events->enable = nv50_gpio_intr_enable;
160 priv->base.events->disable = nv50_gpio_intr_disable;
161 nv_subdev(priv)->intr = nv50_gpio_intr;
162 return 0;
163}
164
165void
166nv50_gpio_dtor(struct nouveau_object *object)
167{
168 struct nv50_gpio_priv *priv = (void *)object;
169 nouveau_gpio_destroy(&priv->base);
170}
171
172int
173nv50_gpio_init(struct nouveau_object *object)
174{
175 struct nv50_gpio_priv *priv = (void *)object;
176 int ret;
177
178 ret = nouveau_gpio_init(&priv->base);
179 if (ret)
180 return ret;
181
182
183 nv_wr32(priv, 0xe050, 0x00000000);
184 nv_wr32(priv, 0xe054, 0xffffffff);
185 if (nv_device(priv)->chipset >= 0x90) {
186 nv_wr32(priv, 0xe070, 0x00000000);
187 nv_wr32(priv, 0xe074, 0xffffffff);
188 }
189
190 return 0;
191}
192
193int
194nv50_gpio_fini(struct nouveau_object *object, bool suspend)
195{
196 struct nv50_gpio_priv *priv = (void *)object;
197 nv_wr32(priv, 0xe050, 0x00000000);
198 if (nv_device(priv)->chipset >= 0x90)
199 nv_wr32(priv, 0xe070, 0x00000000);
200 return nouveau_gpio_fini(&priv->base, suspend);
201}
202
203struct nouveau_oclass
204nv50_gpio_oclass = {
205 .handle = NV_SUBDEV(GPIO, 0x50),
206 .ofuncs = &(struct nouveau_ofuncs) {
207 .ctor = nv50_gpio_ctor,
208 .dtor = nv50_gpio_dtor,
209 .init = nv50_gpio_init,
210 .fini = nv50_gpio_fini,
211 },
212};
213