1 /*
2  * Copyright (C) 2009 Francisco Jerez.
3  * All Rights Reserved.
4  *
5  * Permission is hereby granted, free of charge, to any person obtaining
6  * a copy of this software and associated documentation files (the
7  * "Software"), to deal in the Software without restriction, including
8  * without limitation the rights to use, copy, modify, merge, publish,
9  * distribute, sublicense, and/or sell copies of the Software, and to
10  * permit persons to whom the Software is furnished to do so, subject to
11  * the following conditions:
12  *
13  * The above copyright notice and this permission notice (including the
14  * next paragraph) shall be included in all copies or substantial
15  * portions of the Software.
16  *
17  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
18  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
19  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
20  * IN NO EVENT SHALL THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE
21  * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
22  * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
23  * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
24  *
25  */
26 #include "priv.h"
27 
28 static int
nv10_gpio_sense(struct nvkm_gpio * gpio,int line)29 nv10_gpio_sense(struct nvkm_gpio *gpio, int line)
30 {
31 	struct nvkm_device *device = gpio->subdev.device;
32 	if (line < 2) {
33 		line = line * 16;
34 		line = nvkm_rd32(device, 0x600818) >> line;
35 		return !!(line & 0x0100);
36 	} else
37 	if (line < 10) {
38 		line = (line - 2) * 4;
39 		line = nvkm_rd32(device, 0x60081c) >> line;
40 		return !!(line & 0x04);
41 	} else
42 	if (line < 14) {
43 		line = (line - 10) * 4;
44 		line = nvkm_rd32(device, 0x600850) >> line;
45 		return !!(line & 0x04);
46 	}
47 
48 	return -EINVAL;
49 }
50 
51 static int
nv10_gpio_drive(struct nvkm_gpio * gpio,int line,int dir,int out)52 nv10_gpio_drive(struct nvkm_gpio *gpio, int line, int dir, int out)
53 {
54 	struct nvkm_device *device = gpio->subdev.device;
55 	u32 reg, mask, data;
56 
57 	if (line < 2) {
58 		line = line * 16;
59 		reg  = 0x600818;
60 		mask = 0x00000011;
61 		data = (dir << 4) | out;
62 	} else
63 	if (line < 10) {
64 		line = (line - 2) * 4;
65 		reg  = 0x60081c;
66 		mask = 0x00000003;
67 		data = (dir << 1) | out;
68 	} else
69 	if (line < 14) {
70 		line = (line - 10) * 4;
71 		reg  = 0x600850;
72 		mask = 0x00000003;
73 		data = (dir << 1) | out;
74 	} else {
75 		return -EINVAL;
76 	}
77 
78 	nvkm_mask(device, reg, mask << line, data << line);
79 	return 0;
80 }
81 
82 static void
nv10_gpio_intr_stat(struct nvkm_gpio * gpio,u32 * hi,u32 * lo)83 nv10_gpio_intr_stat(struct nvkm_gpio *gpio, u32 *hi, u32 *lo)
84 {
85 	struct nvkm_device *device = gpio->subdev.device;
86 	u32 intr = nvkm_rd32(device, 0x001104);
87 	u32 stat = nvkm_rd32(device, 0x001144) & intr;
88 	*lo = (stat & 0xffff0000) >> 16;
89 	*hi = (stat & 0x0000ffff);
90 	nvkm_wr32(device, 0x001104, intr);
91 }
92 
93 static void
nv10_gpio_intr_mask(struct nvkm_gpio * gpio,u32 type,u32 mask,u32 data)94 nv10_gpio_intr_mask(struct nvkm_gpio *gpio, u32 type, u32 mask, u32 data)
95 {
96 	struct nvkm_device *device = gpio->subdev.device;
97 	u32 inte = nvkm_rd32(device, 0x001144);
98 	if (type & NVKM_GPIO_LO)
99 		inte = (inte & ~(mask << 16)) | (data << 16);
100 	if (type & NVKM_GPIO_HI)
101 		inte = (inte & ~mask) | data;
102 	nvkm_wr32(device, 0x001144, inte);
103 }
104 
105 static const struct nvkm_gpio_func
106 nv10_gpio = {
107 	.lines = 16,
108 	.intr_stat = nv10_gpio_intr_stat,
109 	.intr_mask = nv10_gpio_intr_mask,
110 	.drive = nv10_gpio_drive,
111 	.sense = nv10_gpio_sense,
112 };
113 
114 int
nv10_gpio_new(struct nvkm_device * device,enum nvkm_subdev_type type,int inst,struct nvkm_gpio ** pgpio)115 nv10_gpio_new(struct nvkm_device *device, enum nvkm_subdev_type type, int inst,
116 	      struct nvkm_gpio **pgpio)
117 {
118 	return nvkm_gpio_new_(&nv10_gpio, device, type, inst, pgpio);
119 }
120