2 * Copyright (c) 2012 Justin Hibbits
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
18 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
19 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
20 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
21 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
22 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/module.h>
34 #include <sys/kernel.h>
36 #include <sys/sysctl.h>
38 #include <machine/bus.h>
40 #include <dev/ofw/openfirm.h>
42 /* From the xf86-video-ati driver's radeon_reg.h */
43 #define RADEON_LVDS_GEN_CNTL 0x02d0
44 #define RADEON_LVDS_ON (1 << 0)
45 #define RADEON_LVDS_DISPLAY_DIS (1 << 1)
46 #define RADEON_LVDS_PANEL_TYPE (1 << 2)
47 #define RADEON_LVDS_PANEL_FORMAT (1 << 3)
48 #define RADEON_LVDS_RST_FM (1 << 6)
49 #define RADEON_LVDS_EN (1 << 7)
50 #define RADEON_LVDS_BL_MOD_LEVEL_SHIFT 8
51 #define RADEON_LVDS_BL_MOD_LEVEL_MASK (0xff << 8)
52 #define RADEON_LVDS_BL_MOD_EN (1 << 16)
53 #define RADEON_LVDS_DIGON (1 << 18)
54 #define RADEON_LVDS_BLON (1 << 19)
58 struct resource *sc_memr;
61 static void atibl_identify(driver_t *driver, device_t parent);
62 static int atibl_probe(device_t dev);
63 static int atibl_attach(device_t dev);
64 static int atibl_setlevel(struct atibl_softc *sc, int newlevel);
65 static int atibl_getlevel(struct atibl_softc *sc);
66 static int atibl_sysctl(SYSCTL_HANDLER_ARGS);
68 static device_method_t atibl_methods[] = {
69 /* Device interface */
70 DEVMETHOD(device_identify, atibl_identify),
71 DEVMETHOD(device_probe, atibl_probe),
72 DEVMETHOD(device_attach, atibl_attach),
76 static driver_t atibl_driver = {
79 sizeof(struct atibl_softc)
82 static devclass_t atibl_devclass;
84 DRIVER_MODULE(atibl, vgapci, atibl_driver, atibl_devclass, 0, 0);
87 atibl_identify(driver_t *driver, device_t parent)
89 if (OF_finddevice("mac-io/backlight") == -1)
91 if (device_find_child(parent, "backlight", -1) == NULL)
92 device_add_child(parent, "backlight", -1);
96 atibl_probe(device_t dev)
101 handle = OF_finddevice("mac-io/backlight");
106 if (OF_getprop(handle, "backlight-control", &control, sizeof(control)) < 0)
109 if (strcmp(control, "ati") != 0)
112 device_set_desc(dev, "PowerBook backlight for ATI graphics");
118 atibl_attach(device_t dev)
120 struct atibl_softc *sc;
121 struct sysctl_ctx_list *ctx;
122 struct sysctl_oid *tree;
125 sc = device_get_softc(dev);
127 rid = 0x18; /* BAR[2], for the MMIO register */
128 sc->sc_memr = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
129 RF_ACTIVE | RF_SHAREABLE);
130 if (sc->sc_memr == NULL) {
131 device_printf(dev, "Could not alloc mem resource!\n");
135 ctx = device_get_sysctl_ctx(dev);
136 tree = device_get_sysctl_tree(dev);
138 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
139 "level", CTLTYPE_INT | CTLFLAG_RW, sc, 0,
140 atibl_sysctl, "I", "Backlight level (0-100)");
146 atibl_setlevel(struct atibl_softc *sc, int newlevel)
148 uint32_t lvds_gen_cntl;
156 newlevel = (newlevel * 5) / 2 + 5;
157 lvds_gen_cntl = bus_read_4(sc->sc_memr, RADEON_LVDS_GEN_CNTL);
158 lvds_gen_cntl |= RADEON_LVDS_BL_MOD_EN;
159 lvds_gen_cntl &= ~RADEON_LVDS_BL_MOD_LEVEL_MASK;
160 lvds_gen_cntl |= (newlevel << RADEON_LVDS_BL_MOD_LEVEL_SHIFT) &
161 RADEON_LVDS_BL_MOD_LEVEL_MASK;
162 bus_write_4(sc->sc_memr, RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
168 atibl_getlevel(struct atibl_softc *sc)
170 uint32_t lvds_gen_cntl;
173 lvds_gen_cntl = bus_read_4(sc->sc_memr, RADEON_LVDS_GEN_CNTL);
175 level = ((lvds_gen_cntl & RADEON_LVDS_BL_MOD_LEVEL_MASK) >>
176 RADEON_LVDS_BL_MOD_LEVEL_SHIFT);
177 level = ((level - 5) * 2) / 5;
183 atibl_sysctl(SYSCTL_HANDLER_ARGS)
185 struct atibl_softc *sc;
190 newlevel = atibl_getlevel(sc);
192 error = sysctl_handle_int(oidp, &newlevel, 0, req);
194 if (error || !req->newptr)
197 return (atibl_setlevel(sc, newlevel));