1 /* $OpenBSD: pwmbl.c,v 1.4 2020/01/28 14:09:31 patrick Exp $ */ 2 /* 3 * Copyright (c) 2019 Krystian Lewandowski 4 * Copyright (c) 2019 Mark Kettenis <kettenis@openbsd.org> 5 * 6 * Permission to use, copy, modify, and distribute this software for any 7 * purpose with or without fee is hereby granted, provided that the above 8 * copyright notice and this permission notice appear in all copies. 9 * 10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 17 */ 18 19 #include <sys/param.h> 20 #include <sys/systm.h> 21 #include <sys/device.h> 22 #include <sys/malloc.h> 23 24 #include <machine/fdt.h> 25 #include <machine/bus.h> 26 27 #include <dev/ofw/openfirm.h> 28 #include <dev/ofw/ofw_gpio.h> 29 #include <dev/ofw/ofw_misc.h> 30 31 #include <dev/wscons/wsconsio.h> 32 #include <dev/wscons/wsdisplayvar.h> 33 34 struct pwmbl_softc { 35 struct device sc_dev; 36 uint32_t *sc_pwm; 37 int sc_pwm_len; 38 uint32_t *sc_levels; 39 int sc_nlevels; 40 uint32_t sc_max_level; 41 uint32_t sc_def_level; 42 }; 43 44 struct pwmbl_softc *sc_pwmbl; 45 46 int pwmbl_match(struct device *, void *, void *); 47 void pwmbl_attach(struct device *, struct device *, void *); 48 49 struct cfattach pwmbl_ca = { 50 sizeof(struct pwmbl_softc), pwmbl_match, pwmbl_attach 51 }; 52 53 struct cfdriver pwmbl_cd = { 54 NULL, "pwmbl", DV_DULL 55 }; 56 57 int pwmbl_get_brightness(void *, uint32_t *); 58 int pwmbl_set_brightness(void *, uint32_t); 59 int pwmbl_get_param(struct wsdisplay_param *); 60 int pwmbl_set_param(struct wsdisplay_param *); 61 62 int 63 pwmbl_match(struct device *parent, void *match, void *aux) 64 { 65 struct fdt_attach_args *faa = aux; 66 67 return OF_is_compatible(faa->fa_node, "pwm-backlight"); 68 } 69 70 void 71 pwmbl_attach(struct device *parent, struct device *self, void *aux) 72 { 73 struct pwmbl_softc *sc = (struct pwmbl_softc *)self; 74 struct fdt_attach_args *faa = aux; 75 uint32_t *gpios; 76 int len; 77 78 len = OF_getproplen(faa->fa_node, "pwms"); 79 if (len < 0) { 80 printf(": no pwm\n"); 81 return; 82 } 83 84 sc->sc_pwm = malloc(len, M_DEVBUF, M_WAITOK); 85 OF_getpropintarray(faa->fa_node, "pwms", sc->sc_pwm, len); 86 sc->sc_pwm_len = len; 87 88 len = OF_getproplen(faa->fa_node, "enable-gpios"); 89 if (len > 0) { 90 gpios = malloc(len, M_TEMP, M_WAITOK); 91 OF_getpropintarray(faa->fa_node, "enable-gpios", gpios, len); 92 gpio_controller_config_pin(&gpios[0], GPIO_CONFIG_OUTPUT); 93 gpio_controller_set_pin(&gpios[0], 1); 94 free(gpios, M_TEMP, len); 95 } 96 97 len = OF_getproplen(faa->fa_node, "brightness-levels"); 98 if (len < 0) { 99 free(sc->sc_pwm, M_DEVBUF, sc->sc_pwm_len); 100 printf(": no brightness levels\n"); 101 return; 102 } 103 104 printf("\n"); 105 106 sc->sc_levels = malloc(len, M_DEVBUF, M_WAITOK); 107 OF_getpropintarray(faa->fa_node, "brightness-levels", 108 sc->sc_levels, len); 109 sc->sc_nlevels = len / sizeof(uint32_t); 110 111 sc->sc_max_level = sc->sc_levels[sc->sc_nlevels - 1]; 112 sc->sc_def_level = OF_getpropint(faa->fa_node, 113 "default-brightness-level", sc->sc_nlevels - 1); 114 if (sc->sc_def_level >= sc->sc_nlevels) 115 sc->sc_def_level = sc->sc_nlevels - 1; 116 sc->sc_def_level = sc->sc_levels[sc->sc_def_level]; 117 118 pwmbl_set_brightness(sc, sc->sc_def_level); 119 120 sc_pwmbl = sc; 121 ws_get_param = pwmbl_get_param; 122 ws_set_param = pwmbl_set_param; 123 } 124 125 int 126 pwmbl_get_brightness(void *cookie, uint32_t *level) 127 { 128 struct pwmbl_softc *sc = cookie; 129 struct pwm_state ps; 130 131 if (pwm_get_state(sc->sc_pwm, &ps)) 132 return EINVAL; 133 134 *level = (ps.ps_pulse_width * sc->sc_max_level) / ps.ps_period; 135 return 0; 136 } 137 138 uint32_t 139 pwmbl_find_brightness(struct pwmbl_softc *sc, uint32_t level) 140 { 141 uint32_t mid; 142 int i; 143 144 for (i = 0; i < sc->sc_nlevels - 1; i++) { 145 mid = (sc->sc_levels[i] + sc->sc_levels[i + 1]) / 2; 146 if (sc->sc_levels[i] <= level && level <= mid) 147 return sc->sc_levels[i]; 148 if (mid < level && level <= sc->sc_levels[i + 1]) 149 return sc->sc_levels[i + 1]; 150 } 151 if (level < sc->sc_levels[0]) 152 return sc->sc_levels[0]; 153 else 154 return sc->sc_levels[i]; 155 } 156 157 int 158 pwmbl_set_brightness(void *cookie, uint32_t level) 159 { 160 struct pwmbl_softc *sc = cookie; 161 struct pwm_state ps; 162 163 if (pwm_init_state(sc->sc_pwm, &ps)) 164 return EINVAL; 165 166 level = pwmbl_find_brightness(sc, level); 167 168 ps.ps_enabled = 1; 169 ps.ps_pulse_width = (ps.ps_period * level) / sc->sc_max_level; 170 return pwm_set_state(sc->sc_pwm, &ps); 171 } 172 173 int 174 pwmbl_get_param(struct wsdisplay_param *dp) 175 { 176 struct pwmbl_softc *sc = (struct pwmbl_softc *)sc_pwmbl; 177 uint32_t level; 178 179 switch (dp->param) { 180 case WSDISPLAYIO_PARAM_BRIGHTNESS: 181 if (pwmbl_get_brightness(sc, &level)) 182 return -1; 183 184 dp->min = 0; 185 dp->max = sc->sc_max_level; 186 dp->curval = level; 187 return 0; 188 default: 189 return -1; 190 } 191 } 192 193 int 194 pwmbl_set_param(struct wsdisplay_param *dp) 195 { 196 struct pwmbl_softc *sc = (struct pwmbl_softc *)sc_pwmbl; 197 198 switch (dp->param) { 199 case WSDISPLAYIO_PARAM_BRIGHTNESS: 200 if (pwmbl_set_brightness(sc, dp->curval)) 201 return -1; 202 return 0; 203 default: 204 return -1; 205 } 206 } 207