/*      $NetBSD: netwalker_backlight.c,v 1.3 2020/05/20 05:10:42 hkenken Exp $  */

/*
* Copyright (c) 2014  Genetec Corporation.  All rights reserved.
* Written by Hashimoto Kenichi for Genetec Corporation.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
*    notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
*    notice, this list of conditions and the following disclaimer in the
*    documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL GENETEC CORPORATION
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: netwalker_backlight.c,v 1.3 2020/05/20 05:10:42 hkenken Exp $");

#include <sys/param.h>
#include <sys/bus.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/pmf.h>

#include <dev/pwm/pwmvar.h>

#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/wsfb/genfbvar.h>

#include <dev/sysmon/sysmonvar.h>
#include <dev/sysmon/sysmon_taskq.h>

#include <arm/imx/imx51reg.h>
#include <arm/imx/imx51var.h>
#include <arm/imx/imx51_ccmvar.h>
#include <arm/imx/imxpwmvar.h>

#include <evbarm/netwalker/netwalker_backlightvar.h>

#define BRIGHTNESS_MAX  255

struct netwalker_backlight_softc {
       struct imxpwm_softc sc_imxpwm;

       int sc_brightness;
       bool sc_islit;
};

static struct netwalker_backlight_softc *netwalker_backlight_sc;

static struct genfb_parameter_callback gpc_backlight;
static struct genfb_parameter_callback gpc_brightness;

static int netwalker_backlight_match(device_t, cfdata_t, void *);
static void netwalker_backlight_attach(device_t, device_t, void *);
static int netwalker_backlight_detach(device_t, int);

CFATTACH_DECL_NEW(netwalker_backlight, sizeof(struct netwalker_backlight_softc),
   netwalker_backlight_match, netwalker_backlight_attach, netwalker_backlight_detach, NULL);

static bool netwalker_backlight_resume(device_t, const pmf_qual_t *);
static bool netwalker_backlight_suspend(device_t, const pmf_qual_t *);
static void netwalker_backlight_on(device_t);
static void netwalker_backlight_off(device_t);
static void netwalker_brightness_up(device_t);
static void netwalker_brightness_down(device_t);
static void netwalker_set_brightness(struct netwalker_backlight_softc *, int);

static int
netwalker_backlight_match(device_t parent, cfdata_t cf, void * aux)
{
       return imxpwm_match(parent, cf, aux);
}

static void
netwalker_backlight_attach(device_t parent, device_t self, void *aux)
{
       struct netwalker_backlight_softc *sc = device_private(self);
       struct imxpwm_softc *imxpwm = &sc->sc_imxpwm;

       imxpwm->sc_dev = self;
       imxpwm->sc_handler = NULL;
       imxpwm->sc_cookie = sc;
       imxpwm_attach(imxpwm, aux);

       aprint_normal(": LCD BackLight Control\n");
       aprint_naive(": LCD BackLight Control\n");

       netwalker_backlight_sc = sc;

       /* BackLight 100% On */
       sc->sc_islit = true;
       netwalker_set_brightness(sc, BRIGHTNESS_MAX);

       if (!pmf_device_register(self, netwalker_backlight_suspend,
               netwalker_backlight_resume))
               aprint_error_dev(self,
                   "couldn't establish backlight handler\n");

       if (!pmf_event_register(self, PMFE_DISPLAY_BRIGHTNESS_UP,
               netwalker_brightness_up, true))
               aprint_error_dev(self,
                   "couldn't register BRIGHTNESS UP event handler\n");
       if (!pmf_event_register(self, PMFE_DISPLAY_BRIGHTNESS_DOWN,
               netwalker_brightness_down, true))
               aprint_error_dev(self,
                   "couldn't register BRIGHTNESS DOWN event handler\n");
       if (!pmf_event_register(self, PMFE_DISPLAY_ON,
               netwalker_backlight_on, true))
               aprint_error_dev(self,
                   "couldn't register DISPLAY ON event handler\n");
       if (!pmf_event_register(self, PMFE_DISPLAY_OFF,
               netwalker_backlight_off, true))
               aprint_error_dev(self,
                   "couldn't register DISPLAY OFF event handler\n");
       if (!pmf_event_register(self, PMFE_CHASSIS_LID_OPEN,
               netwalker_backlight_on, true))
               aprint_error_dev(self,
                   "couldn't register LID OPEN event handler\n");
       if (!pmf_event_register(self, PMFE_CHASSIS_LID_CLOSE,
               netwalker_backlight_off, true))
               aprint_error_dev(self,
                   "couldn't register LID CLOSE event handler\n");
}

static int
netwalker_backlight_detach(device_t self, int flags)
{
       struct netwalker_backlight_softc *sc = device_private(self);

       netwalker_set_brightness(sc, 0);
       pmf_device_deregister(self);
       return 0;
}

static int
netwalker_backlight_get_backlight(void *cookie, int *state)
{
       struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;
       *state = sc->sc_islit;
       return 0;
}

static int
netwalker_backlight_set_backlight(void *cookie, int state)
{
       struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;

       KASSERT(state >= 0 && state <= 1);

       sc->sc_islit = state;
       netwalker_set_brightness(sc, sc->sc_brightness);

       return 0;
}

static int
netwalker_backlight_get_brightness(void *cookie, int *level)
{
       struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;

       if (sc->sc_brightness < 0)
               return ENODEV;

       *level = sc->sc_brightness;
       return 0;
}

static int
netwalker_backlight_set_brightness(void *cookie, int level)
{
       struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;

       KASSERT(level >= 0 && level <= BRIGHTNESS_MAX);

       sc->sc_brightness = level;
       netwalker_set_brightness(sc, sc->sc_brightness);

       return 0;
}

static int
netwalker_backlight_upd_brightness(void *cookie, int delta)
{
       struct netwalker_backlight_softc *sc = *(struct netwalker_backlight_softc **)cookie;

       if (sc->sc_brightness < 0)
               return ENODEV;

       sc->sc_brightness += delta;
       if (sc->sc_brightness < 0) sc->sc_brightness = 0;
       if (sc->sc_brightness > BRIGHTNESS_MAX) sc->sc_brightness = BRIGHTNESS_MAX;
       netwalker_set_brightness(sc, sc->sc_brightness);

       return 0;
}

void
netwalker_backlight_genfb_parameter_set(prop_dictionary_t dict)
{
       gpc_backlight.gpc_cookie = (void *)&netwalker_backlight_sc;
       gpc_backlight.gpc_set_parameter = netwalker_backlight_set_backlight;
       gpc_backlight.gpc_get_parameter = netwalker_backlight_get_backlight;
       gpc_backlight.gpc_upd_parameter = NULL;
       prop_dictionary_set_uint64(dict, "backlight_callback",
           (uint64_t)(uintptr_t)&gpc_backlight);

       gpc_brightness.gpc_cookie = (void *)&netwalker_backlight_sc;
       gpc_brightness.gpc_set_parameter = netwalker_backlight_set_brightness;
       gpc_brightness.gpc_get_parameter = netwalker_backlight_get_brightness;
       gpc_brightness.gpc_upd_parameter = netwalker_backlight_upd_brightness;
       prop_dictionary_set_uint64(dict, "brightness_callback",
           (uint64_t)(uintptr_t)&gpc_brightness);
}

/*
* Power management
*/
static bool
netwalker_backlight_suspend(device_t dv, const pmf_qual_t *qual)
{
       netwalker_backlight_off(dv);
       return true;
}

static bool
netwalker_backlight_resume(device_t dv, const pmf_qual_t *qual)
{
       netwalker_backlight_on(dv);
       return true;
}

static void
netwalker_backlight_on(device_t dv)
{
       struct netwalker_backlight_softc *sc = device_private(dv);
       sc->sc_islit = true;
       netwalker_set_brightness(sc, sc->sc_brightness);
}

static void
netwalker_backlight_off(device_t dv)
{
       struct netwalker_backlight_softc *sc = device_private(dv);
       sc->sc_islit = false;
       netwalker_set_brightness(sc, sc->sc_brightness);
}

static void
netwalker_brightness_up(device_t dv)
{
       struct netwalker_backlight_softc *sc = device_private(dv);
       netwalker_set_brightness(sc, sc->sc_brightness + 1);
}

static void
netwalker_brightness_down(device_t dv)
{
       struct netwalker_backlight_softc *sc = device_private(dv);
       netwalker_set_brightness(sc, sc->sc_brightness - 1);
}

static void
netwalker_set_pwm(struct netwalker_backlight_softc *sc, int val)
{
       pwm_tag_t pwm = &sc->sc_imxpwm.sc_pwm;
       struct pwm_config conf;

       pwm_disable(pwm);
       pwm_get_config(pwm, &conf);
       conf.duty_cycle = (conf.period * val) / BRIGHTNESS_MAX;
       pwm_set_config(pwm, &conf);
       pwm_enable(pwm);
}

static void
netwalker_set_brightness(struct netwalker_backlight_softc *sc, int newval)
{
       if (newval < 0)
               newval = 0;
       else if (newval > BRIGHTNESS_MAX)
               newval = BRIGHTNESS_MAX;
       sc->sc_brightness = newval;

       if (sc->sc_islit)
               netwalker_set_pwm(sc, sc->sc_brightness);
       else
               netwalker_set_pwm(sc, 0);
}

int
netwalker_lcd_param_ioctl(u_long cmd, struct wsdisplay_param *dp)
{
       struct netwalker_backlight_softc *sc = netwalker_backlight_sc;
       int rv = EINVAL;

       switch (dp->param) {
       case WSDISPLAYIO_PARAM_BACKLIGHT:
               if (cmd == WSDISPLAYIO_GETPARAM) {
                       dp->min = 0;
                       dp->max = 1;
                       dp->curval = sc->sc_islit ? 1 : 0;
                       rv = 0;
               } else if (cmd == WSDISPLAYIO_SETPARAM) {
                       if (dp->curval != 0)
                               netwalker_backlight_on(sc->sc_imxpwm.sc_dev);
                       else
                               netwalker_backlight_off(sc->sc_imxpwm.sc_dev);
                       rv = 0;
               }
               break;

       case WSDISPLAYIO_PARAM_CONTRAST:
               /* unsupported */
               rv = ENOTSUP;
               break;

       case WSDISPLAYIO_PARAM_BRIGHTNESS:
               if (cmd == WSDISPLAYIO_GETPARAM) {
                       dp->min = 0;
                       dp->max = BRIGHTNESS_MAX;
                       dp->curval = sc->sc_brightness;
                       rv = 0;
               } else if (cmd == WSDISPLAYIO_SETPARAM) {
                       netwalker_set_brightness(sc, dp->curval);
                       rv = 0;
               }
               break;
       }

       return rv;
}

You are viewing proxied material from ftp.icm.edu.pl. The copyright of proxied material belongs to its original authors. Any comments or complaints in relation to proxied material should be directed to the original authors of the content concerned. Please see the disclaimer for more details.