2 * Copyright 2010 Red Hat Inc.
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20 * OTHER DEALINGS IN THE SOFTWARE.
27 #include "nouveau_drv.h"
28 #include "nouveau_pm.h"
30 static const enum dcb_gpio_tag vidtag
[] = { 0x04, 0x05, 0x06, 0x1a };
31 static int nr_vidtag
= sizeof(vidtag
) / sizeof(vidtag
[0]);
34 nouveau_voltage_gpio_get(struct drm_device
*dev
)
36 struct drm_nouveau_private
*dev_priv
= dev
->dev_private
;
37 struct nouveau_gpio_engine
*gpio
= &dev_priv
->engine
.gpio
;
38 struct nouveau_pm_voltage
*volt
= &dev_priv
->engine
.pm
.voltage
;
42 for (i
= 0; i
< nr_vidtag
; i
++) {
43 if (!(volt
->vid_mask
& (1 << i
)))
46 vid
|= gpio
->get(dev
, vidtag
[i
]) << i
;
49 return nouveau_volt_lvl_lookup(dev
, vid
);
53 nouveau_voltage_gpio_set(struct drm_device
*dev
, int voltage
)
55 struct drm_nouveau_private
*dev_priv
= dev
->dev_private
;
56 struct nouveau_gpio_engine
*gpio
= &dev_priv
->engine
.gpio
;
57 struct nouveau_pm_voltage
*volt
= &dev_priv
->engine
.pm
.voltage
;
60 vid
= nouveau_volt_vid_lookup(dev
, voltage
);
64 for (i
= 0; i
< nr_vidtag
; i
++) {
65 if (!(volt
->vid_mask
& (1 << i
)))
68 gpio
->set(dev
, vidtag
[i
], !!(vid
& (1 << i
)));
75 nouveau_volt_vid_lookup(struct drm_device
*dev
, int voltage
)
77 struct drm_nouveau_private
*dev_priv
= dev
->dev_private
;
78 struct nouveau_pm_voltage
*volt
= &dev_priv
->engine
.pm
.voltage
;
81 for (i
= 0; i
< volt
->nr_level
; i
++) {
82 if (volt
->level
[i
].voltage
== voltage
)
83 return volt
->level
[i
].vid
;
90 nouveau_volt_lvl_lookup(struct drm_device
*dev
, int vid
)
92 struct drm_nouveau_private
*dev_priv
= dev
->dev_private
;
93 struct nouveau_pm_voltage
*volt
= &dev_priv
->engine
.pm
.voltage
;
96 for (i
= 0; i
< volt
->nr_level
; i
++) {
97 if (volt
->level
[i
].vid
== vid
)
98 return volt
->level
[i
].voltage
;
105 nouveau_volt_init(struct drm_device
*dev
)
107 struct drm_nouveau_private
*dev_priv
= dev
->dev_private
;
108 struct nouveau_pm_engine
*pm
= &dev_priv
->engine
.pm
;
109 struct nouveau_pm_voltage
*voltage
= &pm
->voltage
;
110 struct nvbios
*bios
= &dev_priv
->vbios
;
112 u8
*volt
= NULL
, *entry
;
113 int i
, headerlen
, recordlen
, entries
, vidmask
, vidshift
;
115 if (bios
->type
== NVBIOS_BIT
) {
116 if (bit_table(dev
, 'P', &P
))
120 volt
= ROMPTR(bios
, P
.data
[16]);
123 volt
= ROMPTR(bios
, P
.data
[12]);
125 NV_WARN(dev
, "unknown volt for BIT P %d\n", P
.version
);
128 if (bios
->data
[bios
->offset
+ 6] < 0x27) {
129 NV_DEBUG(dev
, "BMP version too old for voltage\n");
133 volt
= ROMPTR(bios
, bios
->data
[bios
->offset
+ 0x98]);
137 NV_DEBUG(dev
, "voltage table pointer invalid\n");
155 vidshift
= 0; /* could be vidshift like 0x30? */
163 /* no longer certain what volt[5] is, if it's related to
164 * the vid shift then it's definitely not a function of
165 * how many bits are set.
167 * after looking at a number of nva3+ vbios images, they
168 * all seem likely to have a static shift of 2.. lets
169 * go with that for now until proven otherwise.
174 NV_WARN(dev
, "voltage table 0x%02x unknown\n", volt
[0]);
178 /* validate vid mask */
179 voltage
->vid_mask
= vidmask
;
180 if (!voltage
->vid_mask
)
186 NV_DEBUG(dev
, "vid bit %d unknown\n", i
);
190 if (!nouveau_bios_gpio_entry(dev
, vidtag
[i
])) {
191 NV_DEBUG(dev
, "vid bit %d has no gpio tag\n", i
);
199 /* parse vbios entries into common format */
200 voltage
->level
= kcalloc(entries
, sizeof(*voltage
->level
), GFP_KERNEL
);
204 entry
= volt
+ headerlen
;
205 for (i
= 0; i
< entries
; i
++, entry
+= recordlen
) {
206 voltage
->level
[i
].voltage
= entry
[0];
207 voltage
->level
[i
].vid
= entry
[1] >> vidshift
;
209 voltage
->nr_level
= entries
;
210 voltage
->supported
= true;
214 nouveau_volt_fini(struct drm_device
*dev
)
216 struct drm_nouveau_private
*dev_priv
= dev
->dev_private
;
217 struct nouveau_pm_voltage
*volt
= &dev_priv
->engine
.pm
.voltage
;