nouveau_backlight.c 9.02 KB
Newer Older
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
26
27
28
29
30
31
32
/*
 * Copyright (C) 2009 Red Hat <mjg@redhat.com>
 *
 * Permission is hereby granted, free of charge, to any person obtaining
 * a copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sublicense, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice (including the
 * next paragraph) shall be included in all copies or substantial
 * portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
 * IN NO EVENT SHALL THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE
 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 */

/*
 * Authors:
 *  Matthew Garrett <mjg@redhat.com>
 *
 * Register locations derived from NVClock by Roderick Colenbrander
 */

33
#include <linux/apple-gmux.h>
34
#include <linux/backlight.h>
35
#include <linux/idr.h>
36

37
#include "nouveau_drv.h"
38
#include "nouveau_reg.h"
39
#include "nouveau_encoder.h"
40

41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
static struct ida bl_ida;
#define BL_NAME_SIZE 15 // 12 for name + 2 for digits + 1 for '\0'

struct backlight_connector {
	struct list_head head;
	int id;
};

static bool
nouveau_get_backlight_name(char backlight_name[BL_NAME_SIZE], struct backlight_connector
		*connector)
{
	const int nb = ida_simple_get(&bl_ida, 0, 0, GFP_KERNEL);
	if (nb < 0 || nb >= 100)
		return false;
	if (nb > 0)
		snprintf(backlight_name, BL_NAME_SIZE, "nv_backlight%d", nb);
	else
		snprintf(backlight_name, BL_NAME_SIZE, "nv_backlight");
	connector->id = nb;
	return true;
}

64
65
static int
nv40_get_intensity(struct backlight_device *bd)
66
{
67
	struct nouveau_drm *drm = bl_get_data(bd);
68
	struct nvif_object *device = &drm->client.device.object;
69
	int val = (nvif_rd32(device, NV40_PMC_BACKLIGHT) &
70
				   NV40_PMC_BACKLIGHT_MASK) >> 16;
71
72
73
74

	return val;
}

75
76
static int
nv40_set_intensity(struct backlight_device *bd)
77
{
78
	struct nouveau_drm *drm = bl_get_data(bd);
79
	struct nvif_object *device = &drm->client.device.object;
80
	int val = bd->props.brightness;
81
	int reg = nvif_rd32(device, NV40_PMC_BACKLIGHT);
82

83
	nvif_wr32(device, NV40_PMC_BACKLIGHT,
84
85
86
87
88
		 (val << 16) | (reg & ~NV40_PMC_BACKLIGHT_MASK));

	return 0;
}

89
static const struct backlight_ops nv40_bl_ops = {
90
91
92
93
94
	.options = BL_CORE_SUSPENDRESUME,
	.get_brightness = nv40_get_intensity,
	.update_status = nv40_set_intensity,
};

95
96
static int
nv40_backlight_init(struct drm_connector *connector)
97
{
98
	struct nouveau_drm *drm = nouveau_drm(connector->dev);
99
	struct nvif_object *device = &drm->client.device.object;
100
	struct backlight_properties props;
101
	struct backlight_device *bd;
102
103
	struct backlight_connector bl_connector;
	char backlight_name[BL_NAME_SIZE];
104

105
	if (!(nvif_rd32(device, NV40_PMC_BACKLIGHT) & NV40_PMC_BACKLIGHT_MASK))
106
107
		return 0;

108
	memset(&props, 0, sizeof(struct backlight_properties));
109
	props.type = BACKLIGHT_RAW;
110
	props.max_brightness = 31;
111
112
113
114
115
	if (!nouveau_get_backlight_name(backlight_name, &bl_connector)) {
		NV_ERROR(drm, "Failed to retrieve a unique name for the backlight interface\n");
		return 0;
	}
	bd = backlight_device_register(backlight_name , connector->kdev, drm,
116
				       &nv40_bl_ops, &props);
117
118

	if (IS_ERR(bd)) {
119
		if (bl_connector.id >= 0)
120
			ida_simple_remove(&bl_ida, bl_connector.id);
121
		return PTR_ERR(bd);
122
123
	}
	list_add(&bl_connector.head, &drm->bl_connectors);
124
	drm->backlight = bd;
125
126
127
128
129
130
	bd->props.brightness = nv40_get_intensity(bd);
	backlight_update_status(bd);

	return 0;
}

131
132
133
static int
nv50_get_intensity(struct backlight_device *bd)
{
134
	struct nouveau_encoder *nv_encoder = bl_get_data(bd);
135
	struct nouveau_drm *drm = nouveau_drm(nv_encoder->base.base.dev);
136
	struct nvif_object *device = &drm->client.device.object;
137
	int or = ffs(nv_encoder->dcb->or) - 1;
138
139
	u32 div = 1025;
	u32 val;
140

141
	val  = nvif_rd32(device, NV50_PDISP_SOR_PWM_CTL(or));
142
	val &= NV50_PDISP_SOR_PWM_CTL_VAL;
143
	return ((val * 100) + (div / 2)) / div;
144
145
146
147
148
}

static int
nv50_set_intensity(struct backlight_device *bd)
{
149
	struct nouveau_encoder *nv_encoder = bl_get_data(bd);
150
	struct nouveau_drm *drm = nouveau_drm(nv_encoder->base.base.dev);
151
	struct nvif_object *device = &drm->client.device.object;
152
	int or = ffs(nv_encoder->dcb->or) - 1;
153
154
	u32 div = 1025;
	u32 val = (bd->props.brightness * div) / 100;
155

156
	nvif_wr32(device, NV50_PDISP_SOR_PWM_CTL(or),
157
			NV50_PDISP_SOR_PWM_CTL_NEW | val);
158
159
160
161
162
163
164
165
166
	return 0;
}

static const struct backlight_ops nv50_bl_ops = {
	.options = BL_CORE_SUSPENDRESUME,
	.get_brightness = nv50_get_intensity,
	.update_status = nv50_set_intensity,
};

167
168
169
170
static int
nva3_get_intensity(struct backlight_device *bd)
{
	struct nouveau_encoder *nv_encoder = bl_get_data(bd);
171
	struct nouveau_drm *drm = nouveau_drm(nv_encoder->base.base.dev);
172
	struct nvif_object *device = &drm->client.device.object;
173
	int or = ffs(nv_encoder->dcb->or) - 1;
174
175
	u32 div, val;

176
177
	div  = nvif_rd32(device, NV50_PDISP_SOR_PWM_DIV(or));
	val  = nvif_rd32(device, NV50_PDISP_SOR_PWM_CTL(or));
178
179
180
181
182
183
184
185
186
187
188
	val &= NVA3_PDISP_SOR_PWM_CTL_VAL;
	if (div && div >= val)
		return ((val * 100) + (div / 2)) / div;

	return 100;
}

static int
nva3_set_intensity(struct backlight_device *bd)
{
	struct nouveau_encoder *nv_encoder = bl_get_data(bd);
189
	struct nouveau_drm *drm = nouveau_drm(nv_encoder->base.base.dev);
190
	struct nvif_object *device = &drm->client.device.object;
191
	int or = ffs(nv_encoder->dcb->or) - 1;
192
193
	u32 div, val;

194
	div = nvif_rd32(device, NV50_PDISP_SOR_PWM_DIV(or));
195
196
	val = (bd->props.brightness * div) / 100;
	if (div) {
197
		nvif_wr32(device, NV50_PDISP_SOR_PWM_CTL(or), val |
198
199
				NV50_PDISP_SOR_PWM_CTL_NEW |
				NVA3_PDISP_SOR_PWM_CTL_UNK);
200
201
202
203
204
205
206
207
208
209
210
211
		return 0;
	}

	return -EINVAL;
}

static const struct backlight_ops nva3_bl_ops = {
	.options = BL_CORE_SUSPENDRESUME,
	.get_brightness = nva3_get_intensity,
	.update_status = nva3_set_intensity,
};

212
213
static int
nv50_backlight_init(struct drm_connector *connector)
214
{
215
	struct nouveau_drm *drm = nouveau_drm(connector->dev);
216
	struct nvif_object *device = &drm->client.device.object;
217
	struct nouveau_encoder *nv_encoder;
218
	struct backlight_properties props;
219
	struct backlight_device *bd;
220
	const struct backlight_ops *ops;
221
222
	struct backlight_connector bl_connector;
	char backlight_name[BL_NAME_SIZE];
223

224
	nv_encoder = find_encoder(connector, DCB_OUTPUT_LVDS);
225
	if (!nv_encoder) {
226
		nv_encoder = find_encoder(connector, DCB_OUTPUT_DP);
227
228
229
230
		if (!nv_encoder)
			return -ENODEV;
	}

231
	if (!nvif_rd32(device, NV50_PDISP_SOR_PWM_CTL(ffs(nv_encoder->dcb->or) - 1)))
232
233
		return 0;

234
235
236
	if (drm->client.device.info.chipset <= 0xa0 ||
	    drm->client.device.info.chipset == 0xaa ||
	    drm->client.device.info.chipset == 0xac)
237
238
239
240
		ops = &nv50_bl_ops;
	else
		ops = &nva3_bl_ops;

241
	memset(&props, 0, sizeof(struct backlight_properties));
242
	props.type = BACKLIGHT_RAW;
243
	props.max_brightness = 100;
244
245
246
247
248
	if (!nouveau_get_backlight_name(backlight_name, &bl_connector)) {
		NV_ERROR(drm, "Failed to retrieve a unique name for the backlight interface\n");
		return 0;
	}
	bd = backlight_device_register(backlight_name , connector->kdev,
249
				       nv_encoder, ops, &props);
250
251

	if (IS_ERR(bd)) {
252
		if (bl_connector.id >= 0)
253
			ida_simple_remove(&bl_ida, bl_connector.id);
254
		return PTR_ERR(bd);
255
	}
256

257
	list_add(&bl_connector.head, &drm->bl_connectors);
258
	drm->backlight = bd;
259
	bd->props.brightness = bd->ops->get_brightness(bd);
260
261
262
263
	backlight_update_status(bd);
	return 0;
}

264
int
265
nouveau_backlight_init(struct drm_device *dev)
266
{
267
	struct nouveau_drm *drm = nouveau_drm(dev);
268
	struct nvif_device *device = &drm->client.device;
269
	struct drm_connector *connector;
270
	struct drm_connector_list_iter conn_iter;
271

272
273
	INIT_LIST_HEAD(&drm->bl_connectors);

274
275
276
277
278
	if (apple_gmux_present()) {
		NV_INFO(drm, "Apple GMUX detected: not registering Nouveau backlight interface\n");
		return 0;
	}

279
280
	drm_connector_list_iter_begin(dev, &conn_iter);
	drm_for_each_connector_iter(connector, &conn_iter) {
281
282
283
284
		if (connector->connector_type != DRM_MODE_CONNECTOR_LVDS &&
		    connector->connector_type != DRM_MODE_CONNECTOR_eDP)
			continue;

285
286
		switch (device->info.family) {
		case NV_DEVICE_INFO_V0_CURIE:
287
			return nv40_backlight_init(connector);
288
289
290
		case NV_DEVICE_INFO_V0_TESLA:
		case NV_DEVICE_INFO_V0_FERMI:
		case NV_DEVICE_INFO_V0_KEPLER:
291
		case NV_DEVICE_INFO_V0_MAXWELL:
292
293
294
295
			return nv50_backlight_init(connector);
		default:
			break;
		}
296
	}
297
	drm_connector_list_iter_end(&conn_iter);
298

299
300
301
	return 0;
}

302
void
303
nouveau_backlight_exit(struct drm_device *dev)
304
{
305
	struct nouveau_drm *drm = nouveau_drm(dev);
306
307
308
309
310
311
	struct backlight_connector *connector;

	list_for_each_entry(connector, &drm->bl_connectors, head) {
		if (connector->id >= 0)
			ida_simple_remove(&bl_ida, connector->id);
	}
312

313
314
315
	if (drm->backlight) {
		backlight_device_unregister(drm->backlight);
		drm->backlight = NULL;
316
317
	}
}
318
319
320
321
322
323
324
325
326
327
328
329

void
nouveau_backlight_ctor(void)
{
	ida_init(&bl_ida);
}

void
nouveau_backlight_dtor(void)
{
	ida_destroy(&bl_ida);
}