]>
Commit | Line | Data |
---|---|---|
6ee73861 BS |
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 | ||
27 | #include "drmP.h" | |
28 | #include "nouveau_drv.h" | |
29 | #include "nouveau_hw.h" | |
30 | ||
31 | static bool | |
32 | get_gpio_location(struct dcb_gpio_entry *ent, uint32_t *reg, uint32_t *shift, | |
33 | uint32_t *mask) | |
34 | { | |
35 | if (ent->line < 2) { | |
36 | *reg = NV_PCRTC_GPIO; | |
37 | *shift = ent->line * 16; | |
38 | *mask = 0x11; | |
39 | ||
40 | } else if (ent->line < 10) { | |
41 | *reg = NV_PCRTC_GPIO_EXT; | |
42 | *shift = (ent->line - 2) * 4; | |
43 | *mask = 0x3; | |
44 | ||
45 | } else if (ent->line < 14) { | |
46 | *reg = NV_PCRTC_850; | |
47 | *shift = (ent->line - 10) * 4; | |
48 | *mask = 0x3; | |
49 | ||
50 | } else { | |
51 | return false; | |
52 | } | |
53 | ||
54 | return true; | |
55 | } | |
56 | ||
57 | int | |
ee2e0131 | 58 | nv10_gpio_get(struct drm_device *dev, enum dcb_gpio_tag tag) |
6ee73861 BS |
59 | { |
60 | struct dcb_gpio_entry *ent = nouveau_bios_gpio_entry(dev, tag); | |
61 | uint32_t reg, shift, mask, value; | |
62 | ||
63 | if (!ent) | |
64 | return -ENODEV; | |
65 | ||
66 | if (!get_gpio_location(ent, ®, &shift, &mask)) | |
67 | return -ENODEV; | |
68 | ||
69 | value = NVReadCRTC(dev, 0, reg) >> shift; | |
70 | ||
71 | return (ent->invert ? 1 : 0) ^ (value & 1); | |
72 | } | |
73 | ||
74 | int | |
ee2e0131 | 75 | nv10_gpio_set(struct drm_device *dev, enum dcb_gpio_tag tag, int state) |
6ee73861 BS |
76 | { |
77 | struct dcb_gpio_entry *ent = nouveau_bios_gpio_entry(dev, tag); | |
78 | uint32_t reg, shift, mask, value; | |
79 | ||
80 | if (!ent) | |
81 | return -ENODEV; | |
82 | ||
83 | if (!get_gpio_location(ent, ®, &shift, &mask)) | |
84 | return -ENODEV; | |
85 | ||
86 | value = ((ent->invert ? 1 : 0) ^ (state ? 1 : 0)) << shift; | |
87 | mask = ~(mask << shift); | |
88 | ||
89 | NVWriteCRTC(dev, 0, reg, value | (NVReadCRTC(dev, 0, reg) & mask)); | |
90 | ||
91 | return 0; | |
92 | } |