Home | History | Annotate | Line # | Download | only in netwalker
netwalker_backlight.c revision 1.1.10.3
      1  1.1.10.2       tls /*	$NetBSD: netwalker_backlight.c,v 1.1.10.3 2017/12/03 11:36:06 jdolecek Exp $	*/
      2  1.1.10.2       tls 
      3  1.1.10.2       tls /*
      4  1.1.10.2       tls  * Copyright (c) 2014  Genetec Corporation.  All rights reserved.
      5  1.1.10.2       tls  * Written by Hashimoto Kenichi for Genetec Corporation.
      6  1.1.10.2       tls  *
      7  1.1.10.2       tls  * Redistribution and use in source and binary forms, with or without
      8  1.1.10.2       tls  * modification, are permitted provided that the following conditions
      9  1.1.10.2       tls  * are met:
     10  1.1.10.2       tls  * 1. Redistributions of source code must retain the above copyright
     11  1.1.10.2       tls  *    notice, this list of conditions and the following disclaimer.
     12  1.1.10.2       tls  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1.10.2       tls  *    notice, this list of conditions and the following disclaimer in the
     14  1.1.10.2       tls  *    documentation and/or other materials provided with the distribution.
     15  1.1.10.2       tls  *
     16  1.1.10.2       tls  * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND
     17  1.1.10.2       tls  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1.10.2       tls  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1.10.2       tls  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL GENETEC CORPORATION
     20  1.1.10.2       tls  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1.10.2       tls  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1.10.2       tls  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1.10.2       tls  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1.10.2       tls  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1.10.2       tls  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1.10.2       tls  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1.10.2       tls  */
     28  1.1.10.2       tls 
     29  1.1.10.2       tls #include <sys/cdefs.h>
     30  1.1.10.2       tls __KERNEL_RCSID(0, "$NetBSD: netwalker_backlight.c,v 1.1.10.3 2017/12/03 11:36:06 jdolecek Exp $");
     31  1.1.10.2       tls 
     32  1.1.10.2       tls #include <sys/param.h>
     33  1.1.10.2       tls #include <sys/bus.h>
     34  1.1.10.2       tls #include <sys/systm.h>
     35  1.1.10.2       tls #include <sys/device.h>
     36  1.1.10.2       tls #include <sys/pmf.h>
     37  1.1.10.2       tls 
     38  1.1.10.2       tls #include <dev/wscons/wsconsio.h>
     39  1.1.10.2       tls #include <dev/wscons/wsdisplayvar.h>
     40  1.1.10.3  jdolecek #include <dev/wsfb/genfbvar.h>
     41  1.1.10.2       tls 
     42  1.1.10.2       tls #include <dev/sysmon/sysmonvar.h>
     43  1.1.10.2       tls #include <dev/sysmon/sysmon_taskq.h>
     44  1.1.10.2       tls 
     45  1.1.10.2       tls #include <arm/imx/imx51reg.h>
     46  1.1.10.2       tls #include <arm/imx/imx51var.h>
     47  1.1.10.2       tls #include <arm/imx/imx51_ccmvar.h>
     48  1.1.10.2       tls #include <arm/imx/imxpwmvar.h>
     49  1.1.10.2       tls 
     50  1.1.10.2       tls #include <evbarm/netwalker/netwalker_backlightvar.h>
     51  1.1.10.2       tls 
     52  1.1.10.3  jdolecek #define BRIGHTNESS_MAX	255
     53  1.1.10.2       tls 
     54  1.1.10.2       tls struct netwalker_backlight_softc {
     55  1.1.10.2       tls 	struct imxpwm_softc sc_imxpwm;
     56  1.1.10.2       tls 
     57  1.1.10.2       tls 	int sc_brightness;
     58  1.1.10.2       tls 	bool sc_islit;
     59  1.1.10.2       tls };
     60  1.1.10.2       tls 
     61  1.1.10.2       tls static struct netwalker_backlight_softc *netwalker_backlight_sc;
     62  1.1.10.2       tls 
     63  1.1.10.3  jdolecek static struct genfb_parameter_callback gpc_backlight;
     64  1.1.10.3  jdolecek static struct genfb_parameter_callback gpc_brightness;
     65  1.1.10.3  jdolecek 
     66  1.1.10.2       tls static int netwalker_backlight_match(device_t, cfdata_t, void *);
     67  1.1.10.2       tls static void netwalker_backlight_attach(device_t, device_t, void *);
     68  1.1.10.2       tls static int netwalker_backlight_detach(device_t, int);
     69  1.1.10.2       tls 
     70  1.1.10.2       tls CFATTACH_DECL_NEW(netwalker_backlight, sizeof(struct netwalker_backlight_softc),
     71  1.1.10.2       tls     netwalker_backlight_match, netwalker_backlight_attach, netwalker_backlight_detach, NULL);
     72  1.1.10.2       tls 
     73  1.1.10.2       tls static bool netwalker_backlight_resume(device_t, const pmf_qual_t *);
     74  1.1.10.2       tls static bool netwalker_backlight_suspend(device_t, const pmf_qual_t *);
     75  1.1.10.2       tls static void netwalker_backlight_on(device_t);
     76  1.1.10.2       tls static void netwalker_backlight_off(device_t);
     77  1.1.10.2       tls static void netwalker_brightness_up(device_t);
     78  1.1.10.2       tls static void netwalker_brightness_down(device_t);
     79  1.1.10.2       tls static void netwalker_set_brightness(struct netwalker_backlight_softc *, int);
     80  1.1.10.2       tls 
     81  1.1.10.2       tls static int
     82  1.1.10.2       tls netwalker_backlight_match(device_t parent, cfdata_t cf, void * aux)
     83  1.1.10.2       tls {
     84  1.1.10.2       tls 	return imxpwm_match(parent, cf, aux);
     85  1.1.10.2       tls }
     86  1.1.10.2       tls 
     87  1.1.10.2       tls static void
     88  1.1.10.2       tls netwalker_backlight_attach(device_t parent, device_t self, void *aux)
     89  1.1.10.2       tls {
     90  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = device_private(self);
     91  1.1.10.2       tls 	struct imxpwm_softc *imxpwm = &sc->sc_imxpwm;
     92  1.1.10.2       tls 
     93  1.1.10.2       tls 	imxpwm->sc_dev = self;
     94  1.1.10.2       tls 	imxpwm->sc_hz = 1000; /* 1000 Hz */
     95  1.1.10.2       tls 	imxpwm->sc_handler = NULL;
     96  1.1.10.2       tls 	imxpwm->sc_cookie = sc;
     97  1.1.10.2       tls 	imxpwm_attach(imxpwm, aux);
     98  1.1.10.2       tls 
     99  1.1.10.2       tls 	aprint_normal(": LCD BackLight Control\n");
    100  1.1.10.2       tls 	aprint_naive(": LCD BackLight Control\n");
    101  1.1.10.2       tls 
    102  1.1.10.2       tls 	netwalker_backlight_sc = sc;
    103  1.1.10.2       tls 
    104  1.1.10.2       tls 	/* BackLight 100% On */
    105  1.1.10.2       tls 	sc->sc_brightness = BRIGHTNESS_MAX;
    106  1.1.10.2       tls 	sc->sc_islit = true;
    107  1.1.10.2       tls 	imxpwm_set_pwm(imxpwm, 1000);
    108  1.1.10.2       tls 
    109  1.1.10.2       tls 	if (!pmf_device_register(self, netwalker_backlight_suspend,
    110  1.1.10.2       tls 		netwalker_backlight_resume))
    111  1.1.10.2       tls 		aprint_error_dev(self,
    112  1.1.10.2       tls 		    "couldn't establish backlight handler\n");
    113  1.1.10.2       tls 
    114  1.1.10.2       tls 	if (!pmf_event_register(self, PMFE_DISPLAY_BRIGHTNESS_UP,
    115  1.1.10.2       tls 		netwalker_brightness_up, true))
    116  1.1.10.2       tls 		aprint_error_dev(self,
    117  1.1.10.2       tls 		    "couldn't register BRIGHTNESS UP event handler\n");
    118  1.1.10.2       tls 	if (!pmf_event_register(self, PMFE_DISPLAY_BRIGHTNESS_DOWN,
    119  1.1.10.2       tls 		netwalker_brightness_down, true))
    120  1.1.10.2       tls 		aprint_error_dev(self,
    121  1.1.10.2       tls 		    "couldn't register BRIGHTNESS DOWN event handler\n");
    122  1.1.10.2       tls 	if (!pmf_event_register(self, PMFE_DISPLAY_ON,
    123  1.1.10.2       tls 		netwalker_backlight_on, true))
    124  1.1.10.2       tls 		aprint_error_dev(self,
    125  1.1.10.2       tls 		    "couldn't register DISPLAY ON event handler\n");
    126  1.1.10.2       tls 	if (!pmf_event_register(self, PMFE_DISPLAY_OFF,
    127  1.1.10.2       tls 		netwalker_backlight_off, true))
    128  1.1.10.2       tls 		aprint_error_dev(self,
    129  1.1.10.2       tls 		    "couldn't register DISPLAY OFF event handler\n");
    130  1.1.10.2       tls 	if (!pmf_event_register(self, PMFE_CHASSIS_LID_OPEN,
    131  1.1.10.2       tls 		netwalker_backlight_on, true))
    132  1.1.10.2       tls 		aprint_error_dev(self,
    133  1.1.10.2       tls 		    "couldn't register LID OPEN event handler\n");
    134  1.1.10.2       tls 	if (!pmf_event_register(self, PMFE_CHASSIS_LID_CLOSE,
    135  1.1.10.2       tls 		netwalker_backlight_off, true))
    136  1.1.10.2       tls 		aprint_error_dev(self,
    137  1.1.10.2       tls 		    "couldn't register LID CLOSE event handler\n");
    138  1.1.10.2       tls }
    139  1.1.10.2       tls 
    140  1.1.10.2       tls static int
    141  1.1.10.2       tls netwalker_backlight_detach(device_t self, int flags)
    142  1.1.10.2       tls {
    143  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = device_private(self);
    144  1.1.10.2       tls 	struct imxpwm_softc *imxpwm = &sc->sc_imxpwm;
    145  1.1.10.2       tls 
    146  1.1.10.2       tls 	imxpwm_set_pwm(imxpwm, 0);
    147  1.1.10.2       tls 	pmf_device_deregister(self);
    148  1.1.10.2       tls 	return 0;
    149  1.1.10.2       tls }
    150  1.1.10.2       tls 
    151  1.1.10.3  jdolecek static int
    152  1.1.10.3  jdolecek netwalker_backlight_get_backlight(void *cookie, int *state)
    153  1.1.10.3  jdolecek {
    154  1.1.10.3  jdolecek 	struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;
    155  1.1.10.3  jdolecek 	*state = sc->sc_islit;
    156  1.1.10.3  jdolecek 	return 0;
    157  1.1.10.3  jdolecek }
    158  1.1.10.3  jdolecek 
    159  1.1.10.3  jdolecek static int
    160  1.1.10.3  jdolecek netwalker_backlight_set_backlight(void *cookie, int state)
    161  1.1.10.3  jdolecek {
    162  1.1.10.3  jdolecek 	struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;
    163  1.1.10.3  jdolecek 
    164  1.1.10.3  jdolecek 	KASSERT(state >= 0 && state <= 1);
    165  1.1.10.3  jdolecek 
    166  1.1.10.3  jdolecek 	sc->sc_islit = state;
    167  1.1.10.3  jdolecek 	netwalker_set_brightness(sc, sc->sc_brightness);
    168  1.1.10.3  jdolecek 
    169  1.1.10.3  jdolecek 	return 0;
    170  1.1.10.3  jdolecek }
    171  1.1.10.3  jdolecek 
    172  1.1.10.3  jdolecek static int
    173  1.1.10.3  jdolecek netwalker_backlight_get_brightness(void *cookie, int *level)
    174  1.1.10.3  jdolecek {
    175  1.1.10.3  jdolecek 	struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;
    176  1.1.10.3  jdolecek 
    177  1.1.10.3  jdolecek 	if (sc->sc_brightness < 0)
    178  1.1.10.3  jdolecek 		return ENODEV;
    179  1.1.10.3  jdolecek 
    180  1.1.10.3  jdolecek 	*level = sc->sc_brightness;
    181  1.1.10.3  jdolecek 	return 0;
    182  1.1.10.3  jdolecek }
    183  1.1.10.3  jdolecek 
    184  1.1.10.3  jdolecek static int
    185  1.1.10.3  jdolecek netwalker_backlight_set_brightness(void *cookie, int level)
    186  1.1.10.3  jdolecek {
    187  1.1.10.3  jdolecek 	struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;
    188  1.1.10.3  jdolecek 
    189  1.1.10.3  jdolecek 	KASSERT(level >= 0 && level <= 255);
    190  1.1.10.3  jdolecek 
    191  1.1.10.3  jdolecek 	sc->sc_brightness = level;
    192  1.1.10.3  jdolecek 	netwalker_set_brightness(sc, sc->sc_brightness);
    193  1.1.10.3  jdolecek 
    194  1.1.10.3  jdolecek 	return 0;
    195  1.1.10.3  jdolecek }
    196  1.1.10.3  jdolecek 
    197  1.1.10.3  jdolecek static int
    198  1.1.10.3  jdolecek netwalker_backlight_upd_brightness(void *cookie, int delta)
    199  1.1.10.3  jdolecek {
    200  1.1.10.3  jdolecek 	struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;
    201  1.1.10.3  jdolecek 
    202  1.1.10.3  jdolecek 	if (sc->sc_brightness < 0)
    203  1.1.10.3  jdolecek 		return ENODEV;
    204  1.1.10.3  jdolecek 
    205  1.1.10.3  jdolecek 	sc->sc_brightness += delta;
    206  1.1.10.3  jdolecek 	if (sc->sc_brightness < 0) sc->sc_brightness = 0;
    207  1.1.10.3  jdolecek 	if (sc->sc_brightness > 255) sc->sc_brightness = 255;
    208  1.1.10.3  jdolecek 	netwalker_set_brightness(sc, sc->sc_brightness);
    209  1.1.10.3  jdolecek 
    210  1.1.10.3  jdolecek 	return 0;
    211  1.1.10.3  jdolecek }
    212  1.1.10.3  jdolecek 
    213  1.1.10.3  jdolecek void
    214  1.1.10.3  jdolecek netwalker_backlight_genfb_parameter_set(prop_dictionary_t dict)
    215  1.1.10.3  jdolecek {
    216  1.1.10.3  jdolecek 	gpc_backlight.gpc_cookie = (void *)&netwalker_backlight_sc;
    217  1.1.10.3  jdolecek 	gpc_backlight.gpc_set_parameter = netwalker_backlight_set_backlight;
    218  1.1.10.3  jdolecek 	gpc_backlight.gpc_get_parameter = netwalker_backlight_get_backlight;
    219  1.1.10.3  jdolecek 	gpc_backlight.gpc_upd_parameter = NULL;
    220  1.1.10.3  jdolecek 	prop_dictionary_set_uint64(dict, "backlight_callback",
    221  1.1.10.3  jdolecek 	    (uint64_t)(uintptr_t)&gpc_backlight);
    222  1.1.10.3  jdolecek 
    223  1.1.10.3  jdolecek 	gpc_brightness.gpc_cookie = (void *)&netwalker_backlight_sc;
    224  1.1.10.3  jdolecek 	gpc_brightness.gpc_set_parameter = netwalker_backlight_set_brightness;
    225  1.1.10.3  jdolecek 	gpc_brightness.gpc_get_parameter = netwalker_backlight_get_brightness;
    226  1.1.10.3  jdolecek 	gpc_brightness.gpc_upd_parameter = netwalker_backlight_upd_brightness;
    227  1.1.10.3  jdolecek 	prop_dictionary_set_uint64(dict, "brightness_callback",
    228  1.1.10.3  jdolecek 	    (uint64_t)(uintptr_t)&gpc_brightness);
    229  1.1.10.3  jdolecek }
    230  1.1.10.3  jdolecek 
    231  1.1.10.2       tls /*
    232  1.1.10.2       tls  * Power management
    233  1.1.10.2       tls  */
    234  1.1.10.2       tls static bool
    235  1.1.10.2       tls netwalker_backlight_suspend(device_t dv, const pmf_qual_t *qual)
    236  1.1.10.2       tls {
    237  1.1.10.2       tls 	netwalker_backlight_off(dv);
    238  1.1.10.2       tls  	return true;
    239  1.1.10.2       tls }
    240  1.1.10.2       tls 
    241  1.1.10.2       tls static bool
    242  1.1.10.2       tls netwalker_backlight_resume(device_t dv, const pmf_qual_t *qual)
    243  1.1.10.2       tls {
    244  1.1.10.2       tls 	netwalker_backlight_on(dv);
    245  1.1.10.2       tls 	return true;
    246  1.1.10.2       tls }
    247  1.1.10.2       tls 
    248  1.1.10.2       tls static void
    249  1.1.10.2       tls netwalker_backlight_on(device_t dv)
    250  1.1.10.2       tls {
    251  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = device_private(dv);
    252  1.1.10.2       tls 	sc->sc_islit = true;
    253  1.1.10.2       tls 	netwalker_set_brightness(sc, sc->sc_brightness);
    254  1.1.10.2       tls }
    255  1.1.10.2       tls 
    256  1.1.10.2       tls static void
    257  1.1.10.2       tls netwalker_backlight_off(device_t dv)
    258  1.1.10.2       tls {
    259  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = device_private(dv);
    260  1.1.10.2       tls 	sc->sc_islit = false;
    261  1.1.10.2       tls 	netwalker_set_brightness(sc, sc->sc_brightness);
    262  1.1.10.2       tls }
    263  1.1.10.2       tls 
    264  1.1.10.2       tls static void
    265  1.1.10.2       tls netwalker_brightness_up(device_t dv)
    266  1.1.10.2       tls {
    267  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = device_private(dv);
    268  1.1.10.2       tls 	netwalker_set_brightness(sc, sc->sc_brightness + 1);
    269  1.1.10.2       tls }
    270  1.1.10.2       tls 
    271  1.1.10.2       tls static void
    272  1.1.10.2       tls netwalker_brightness_down(device_t dv)
    273  1.1.10.2       tls {
    274  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = device_private(dv);
    275  1.1.10.2       tls 	netwalker_set_brightness(sc, sc->sc_brightness - 1);
    276  1.1.10.2       tls }
    277  1.1.10.2       tls 
    278  1.1.10.2       tls static void
    279  1.1.10.2       tls netwalker_set_brightness(struct netwalker_backlight_softc *sc, int newval)
    280  1.1.10.2       tls {
    281  1.1.10.2       tls 	struct imxpwm_softc *imxpwm = &sc->sc_imxpwm;
    282  1.1.10.2       tls 
    283  1.1.10.2       tls 	if (newval < 0)
    284  1.1.10.2       tls 		newval = 0;
    285  1.1.10.2       tls 	else if (newval > BRIGHTNESS_MAX)
    286  1.1.10.2       tls 		newval = BRIGHTNESS_MAX;
    287  1.1.10.2       tls 	sc->sc_brightness = newval;
    288  1.1.10.2       tls 
    289  1.1.10.2       tls 	if (sc->sc_islit)
    290  1.1.10.2       tls 		imxpwm_set_pwm(imxpwm, 1000 * sc->sc_brightness / BRIGHTNESS_MAX);
    291  1.1.10.2       tls 	else
    292  1.1.10.2       tls 		imxpwm_set_pwm(imxpwm, 0);
    293  1.1.10.2       tls }
    294  1.1.10.2       tls 
    295  1.1.10.2       tls int
    296  1.1.10.2       tls netwalker_lcd_param_ioctl(u_long cmd, struct wsdisplay_param *dp)
    297  1.1.10.2       tls {
    298  1.1.10.2       tls 	struct netwalker_backlight_softc *sc = netwalker_backlight_sc;
    299  1.1.10.2       tls 	int rv = EINVAL;
    300  1.1.10.2       tls 
    301  1.1.10.2       tls 	switch (dp->param) {
    302  1.1.10.2       tls 	case WSDISPLAYIO_PARAM_BACKLIGHT:
    303  1.1.10.2       tls 		if (cmd == WSDISPLAYIO_GETPARAM) {
    304  1.1.10.2       tls 			dp->min = 0;
    305  1.1.10.2       tls 			dp->max = 1;
    306  1.1.10.2       tls 			dp->curval = sc->sc_islit ? 1 : 0;
    307  1.1.10.2       tls 			rv = 0;
    308  1.1.10.2       tls 		} else if (cmd == WSDISPLAYIO_SETPARAM) {
    309  1.1.10.2       tls 			if (dp->curval != 0)
    310  1.1.10.2       tls 				netwalker_backlight_on(sc->sc_imxpwm.sc_dev);
    311  1.1.10.2       tls 			else
    312  1.1.10.2       tls 				netwalker_backlight_off(sc->sc_imxpwm.sc_dev);
    313  1.1.10.2       tls 			rv = 0;
    314  1.1.10.2       tls 		}
    315  1.1.10.2       tls 		break;
    316  1.1.10.2       tls 
    317  1.1.10.2       tls 	case WSDISPLAYIO_PARAM_CONTRAST:
    318  1.1.10.2       tls 		/* unsupported */
    319  1.1.10.2       tls 		rv = ENOTSUP;
    320  1.1.10.2       tls 		break;
    321  1.1.10.2       tls 
    322  1.1.10.2       tls 	case WSDISPLAYIO_PARAM_BRIGHTNESS:
    323  1.1.10.2       tls 		if (cmd == WSDISPLAYIO_GETPARAM) {
    324  1.1.10.2       tls 			dp->min = 0;
    325  1.1.10.2       tls 			dp->max = BRIGHTNESS_MAX;
    326  1.1.10.2       tls 			dp->curval = sc->sc_brightness;
    327  1.1.10.2       tls 			rv = 0;
    328  1.1.10.2       tls 		} else if (cmd == WSDISPLAYIO_SETPARAM) {
    329  1.1.10.2       tls 			netwalker_set_brightness(sc, dp->curval);
    330  1.1.10.2       tls 			rv = 0;
    331  1.1.10.2       tls 		}
    332  1.1.10.2       tls 		break;
    333  1.1.10.2       tls 	}
    334  1.1.10.2       tls 
    335  1.1.10.2       tls 	return rv;
    336  1.1.10.2       tls }
    337