Home | History | Annotate | Line # | Download | only in dev
psh3lcd.c revision 1.2.18.3
      1  1.2.18.3  yamt /*	$NetBSD: psh3lcd.c,v 1.2.18.3 2007/02/26 09:06:39 yamt Exp $	*/
      2  1.2.18.2  yamt /*
      3  1.2.18.2  yamt  * Copyright (c) 2005 KIYOHARA Takashi
      4  1.2.18.2  yamt  * All rights reserved.
      5  1.2.18.2  yamt  *
      6  1.2.18.2  yamt  * Redistribution and use in source and binary forms, with or without
      7  1.2.18.2  yamt  * modification, are permitted provided that the following conditions
      8  1.2.18.2  yamt  * are met:
      9  1.2.18.2  yamt  * 1. Redistributions of source code must retain the above copyright
     10  1.2.18.2  yamt  *    notice, this list of conditions and the following disclaimer.
     11  1.2.18.2  yamt  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.2.18.2  yamt  *    notice, this list of conditions and the following disclaimer in the
     13  1.2.18.2  yamt  *    documentation and/or other materials provided with the distribution.
     14  1.2.18.2  yamt  *
     15  1.2.18.2  yamt  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  1.2.18.2  yamt  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17  1.2.18.2  yamt  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18  1.2.18.2  yamt  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19  1.2.18.2  yamt  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20  1.2.18.2  yamt  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21  1.2.18.2  yamt  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22  1.2.18.2  yamt  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23  1.2.18.2  yamt  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24  1.2.18.2  yamt  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25  1.2.18.2  yamt  * POSSIBILITY OF SUCH DAMAGE.
     26  1.2.18.2  yamt  *
     27  1.2.18.2  yamt  */
     28  1.2.18.2  yamt 
     29  1.2.18.2  yamt #include <sys/cdefs.h>
     30  1.2.18.2  yamt 
     31  1.2.18.3  yamt #include <sys/types.h>
     32  1.2.18.2  yamt #include <sys/param.h>
     33  1.2.18.2  yamt #include <sys/device.h>
     34  1.2.18.3  yamt #include <sys/errno.h>
     35  1.2.18.3  yamt #include <sys/kernel.h>
     36  1.2.18.2  yamt #include <sys/systm.h>
     37  1.2.18.2  yamt #include <sys/callout.h>
     38  1.2.18.2  yamt 
     39  1.2.18.2  yamt #include <machine/platid.h>
     40  1.2.18.2  yamt #include <machine/platid_mask.h>
     41  1.2.18.2  yamt 
     42  1.2.18.2  yamt #include <machine/config_hook.h>
     43  1.2.18.2  yamt 
     44  1.2.18.2  yamt #include <sh3/pfcreg.h>
     45  1.2.18.2  yamt #include <hpcsh/dev/hd64461/hd64461var.h>
     46  1.2.18.2  yamt #include <hpcsh/dev/hd64461/hd64461reg.h>
     47  1.2.18.2  yamt #include <hpcsh/dev/hd64461/hd64461gpioreg.h>
     48  1.2.18.2  yamt 
     49  1.2.18.2  yamt 
     50  1.2.18.2  yamt /*
     51  1.2.18.2  yamt  * LCD contrast INC#: controlled by pin 0 in HD64461 GPIO port A.
     52  1.2.18.2  yamt  * LCD contrast  CS#: controlled by pin 1 in HD64461 GPIO port A.
     53  1.2.18.2  yamt  * LCD contrast U/D#: controlled by pin 0 in SH7709 GPIO port D.
     54  1.2.18.2  yamt  *   0 - down
     55  1.2.18.2  yamt  *   1 - up
     56  1.2.18.2  yamt  */
     57  1.2.18.2  yamt #define PSH3LCD_CONTRAST_INC		0x01
     58  1.2.18.2  yamt #define PSH3LCD_CONTRAST_CS		0x02
     59  1.2.18.2  yamt #define PSH3LCD_CONTRAST_UD		0x01
     60  1.2.18.2  yamt 
     61  1.2.18.2  yamt /*
     62  1.2.18.2  yamt  * LCD brightness: controled by HG71C105FE at AREA2.
     63  1.2.18.2  yamt  *	XXXX: That is custom IC. We don't know spec.  X-<
     64  1.2.18.2  yamt  */
     65  1.2.18.2  yamt #define PSH3LCD_BRIGHTNESS_REG0		0xaa000072
     66  1.2.18.2  yamt #define PSH3LCD_BRIGHTNESS_REG1		0xaa000150
     67  1.2.18.2  yamt #define PSH3LCD_BRIGHTNESS_REG2		0xaa000152
     68  1.2.18.2  yamt 
     69  1.2.18.2  yamt /* brightness control data */
     70  1.2.18.2  yamt static const struct psh3lcd_x0_bcd {	/* 50PA, 30PA */
     71  1.2.18.2  yamt 	uint8_t reg0;
     72  1.2.18.2  yamt 	uint8_t reg1;
     73  1.2.18.2  yamt 	uint8_t reg2;
     74  1.2.18.2  yamt } psh3lcd_x0_bcd[] = {
     75  1.2.18.2  yamt 	{ 0x05, 0x08, 0x1e },
     76  1.2.18.2  yamt 	{ 0x05, 0x1d, 0x09 },
     77  1.2.18.2  yamt 	{ 0x04, 0x1e, 0x1e },
     78  1.2.18.2  yamt 	{ 0x06, 0x1e, 0x1e },
     79  1.2.18.2  yamt 	{ 0x07, 0x1e, 0x1e },
     80  1.2.18.2  yamt 	{ 0x00, 0x00, 0x00 }
     81  1.2.18.2  yamt };
     82  1.2.18.2  yamt static const struct psh3lcd_xx0_bcd {	/* 200JC */
     83  1.2.18.2  yamt 	uint8_t reg1;
     84  1.2.18.2  yamt 	uint8_t reg2;
     85  1.2.18.2  yamt } psh3lcd_xx0_bcd[] = {
     86  1.2.18.2  yamt 	{ 0x33, 0x0c },
     87  1.2.18.2  yamt 	{ 0x2d, 0x12 },
     88  1.2.18.2  yamt 	{ 0x26, 0x19 },
     89  1.2.18.2  yamt 	{ 0x20, 0x1f },
     90  1.2.18.2  yamt 	{ 0x1a, 0x25 },
     91  1.2.18.2  yamt 	{ 0x13, 0x2c },
     92  1.2.18.2  yamt 	{ 0x0d, 0x32 },
     93  1.2.18.2  yamt 	{ 0x07, 0x38 },
     94  1.2.18.2  yamt 	{ 0x01, 0x00 },
     95  1.2.18.2  yamt 	{ 0x00, 0x00 }
     96  1.2.18.2  yamt };
     97  1.2.18.2  yamt 
     98  1.2.18.2  yamt #define PSH3LCD_XX0_BRIGHTNESS_MAX	8
     99  1.2.18.2  yamt #define PSH3LCD_X0_BRIGHTNESS_MAX	4
    100  1.2.18.2  yamt 
    101  1.2.18.2  yamt #define PSH3LCD_CONTRAST_MAX		2	/* XXX */
    102  1.2.18.2  yamt #define PSH3LCD_CONTRAST		1
    103  1.2.18.2  yamt #define PSH3LCD_CONTRAST_UP		2
    104  1.2.18.2  yamt #define PSH3LCD_CONTRAST_DOWN		0
    105  1.2.18.2  yamt 
    106  1.2.18.2  yamt #define BCD_NO_MATCH	(-1)
    107  1.2.18.2  yamt 
    108  1.2.18.2  yamt 
    109  1.2.18.2  yamt struct psh3lcd_softc {
    110  1.2.18.2  yamt 	struct device sc_dev;
    111  1.2.18.2  yamt 	int sc_brightness;
    112  1.2.18.2  yamt 	int sc_brightness_max;
    113  1.2.18.2  yamt 	void (*sc_set_brightness)(int);
    114  1.2.18.2  yamt };
    115  1.2.18.2  yamt 
    116  1.2.18.2  yamt static int psh3lcd_match(struct device *, struct cfdata *, void *);
    117  1.2.18.2  yamt static void psh3lcd_attach(struct device *, struct device *, void *);
    118  1.2.18.2  yamt 
    119  1.2.18.2  yamt CFATTACH_DECL(psh3lcd, sizeof(struct psh3lcd_softc),
    120  1.2.18.2  yamt     psh3lcd_match, psh3lcd_attach, NULL, NULL);
    121  1.2.18.2  yamt 
    122  1.2.18.2  yamt 
    123  1.2.18.2  yamt static inline int psh3lcd_x0_bcd_get(void);
    124  1.2.18.2  yamt static inline int psh3lcd_xx0_bcd_get(void);
    125  1.2.18.2  yamt static void psh3lcd_x0_set_brightness(int);
    126  1.2.18.2  yamt static void psh3lcd_xx0_set_brightness(int);
    127  1.2.18.2  yamt static void psh3lcd_set_contrast(int);
    128  1.2.18.2  yamt static int psh3lcd_param(void *, int, long, void *);
    129  1.2.18.2  yamt static int psh3lcd_power(void *, int, long, void *);
    130  1.2.18.2  yamt 
    131  1.2.18.2  yamt 
    132  1.2.18.2  yamt static inline int
    133  1.2.18.2  yamt psh3lcd_x0_bcd_get()
    134  1.2.18.2  yamt {
    135  1.2.18.2  yamt 	int i;
    136  1.2.18.2  yamt 	uint8_t bcr0, bcr1, bcr2;
    137  1.2.18.2  yamt 
    138  1.2.18.2  yamt 	bcr0 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG0);
    139  1.2.18.2  yamt 	bcr1 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG1);
    140  1.2.18.2  yamt 	bcr2 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG2);
    141  1.2.18.2  yamt 
    142  1.2.18.2  yamt 	for (i = 0; psh3lcd_x0_bcd[i].reg0 != 0; i++)
    143  1.2.18.2  yamt 		if (bcr0 == psh3lcd_x0_bcd[i].reg0 &&
    144  1.2.18.2  yamt 		    bcr1 == psh3lcd_x0_bcd[i].reg1 &&
    145  1.2.18.2  yamt 		    bcr2 == psh3lcd_x0_bcd[i].reg2)
    146  1.2.18.2  yamt 			break;
    147  1.2.18.2  yamt 	if (psh3lcd_x0_bcd[i].reg0 == 0)
    148  1.2.18.3  yamt 		return BCD_NO_MATCH;
    149  1.2.18.3  yamt 	return i;
    150  1.2.18.2  yamt }
    151  1.2.18.2  yamt 
    152  1.2.18.2  yamt static inline int
    153  1.2.18.2  yamt psh3lcd_xx0_bcd_get()
    154  1.2.18.2  yamt {
    155  1.2.18.2  yamt 	int i;
    156  1.2.18.2  yamt 	uint8_t bcr1, bcr2;
    157  1.2.18.2  yamt 
    158  1.2.18.2  yamt 	bcr1 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG1);
    159  1.2.18.2  yamt 	bcr2 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG2);
    160  1.2.18.2  yamt 
    161  1.2.18.2  yamt 	for (i = 0; psh3lcd_xx0_bcd[i].reg1 != 0; i++)
    162  1.2.18.2  yamt 		if (bcr1 == psh3lcd_xx0_bcd[i].reg1 &&
    163  1.2.18.2  yamt 		    bcr2 == psh3lcd_xx0_bcd[i].reg2)
    164  1.2.18.2  yamt 			break;
    165  1.2.18.2  yamt 	if (psh3lcd_xx0_bcd[i].reg1 == 0)
    166  1.2.18.3  yamt 		return BCD_NO_MATCH;
    167  1.2.18.3  yamt 	return i;
    168  1.2.18.2  yamt }
    169  1.2.18.2  yamt 
    170  1.2.18.2  yamt static void
    171  1.2.18.2  yamt psh3lcd_xx0_set_brightness(int index)
    172  1.2.18.2  yamt {
    173  1.2.18.2  yamt 
    174  1.2.18.2  yamt 	_reg_write_1(PSH3LCD_BRIGHTNESS_REG1, psh3lcd_xx0_bcd[index].reg1);
    175  1.2.18.2  yamt 	_reg_write_1(PSH3LCD_BRIGHTNESS_REG2, psh3lcd_xx0_bcd[index].reg2);
    176  1.2.18.2  yamt }
    177  1.2.18.2  yamt 
    178  1.2.18.2  yamt static void
    179  1.2.18.2  yamt psh3lcd_x0_set_brightness(int index)
    180  1.2.18.2  yamt {
    181  1.2.18.2  yamt 
    182  1.2.18.2  yamt 	_reg_write_1(PSH3LCD_BRIGHTNESS_REG0, psh3lcd_x0_bcd[index].reg0);
    183  1.2.18.2  yamt 	_reg_write_1(PSH3LCD_BRIGHTNESS_REG1, psh3lcd_x0_bcd[index].reg1);
    184  1.2.18.2  yamt 	_reg_write_1(PSH3LCD_BRIGHTNESS_REG2, psh3lcd_x0_bcd[index].reg2);
    185  1.2.18.2  yamt }
    186  1.2.18.2  yamt 
    187  1.2.18.2  yamt /*
    188  1.2.18.2  yamt  * contrast control function.  controlled by IC (X9313W).
    189  1.2.18.2  yamt  */
    190  1.2.18.2  yamt inline void
    191  1.2.18.2  yamt psh3lcd_set_contrast(int value)
    192  1.2.18.2  yamt {
    193  1.2.18.2  yamt 	uint16_t gpadr;
    194  1.2.18.2  yamt 	uint8_t pddr;
    195  1.2.18.2  yamt 
    196  1.2.18.2  yamt 	/* CS assert */
    197  1.2.18.2  yamt 	gpadr = hd64461_reg_read_2(HD64461_GPADR_REG16);
    198  1.2.18.2  yamt 	gpadr &= ~PSH3LCD_CONTRAST_CS;
    199  1.2.18.2  yamt 	hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr);
    200  1.2.18.2  yamt 	delay(1);
    201  1.2.18.2  yamt 
    202  1.2.18.2  yamt 	/* set U/D# */
    203  1.2.18.2  yamt 	pddr = _reg_read_1(SH7709_PDDR);
    204  1.2.18.2  yamt 	if (value == PSH3LCD_CONTRAST_UP)
    205  1.2.18.2  yamt 		pddr |= PSH3LCD_CONTRAST_UD;
    206  1.2.18.2  yamt 	else if (value == PSH3LCD_CONTRAST_DOWN)
    207  1.2.18.2  yamt 		pddr &= ~PSH3LCD_CONTRAST_UD;
    208  1.2.18.2  yamt 	_reg_write_1(SH7709_PDDR, pddr);
    209  1.2.18.2  yamt 	delay(3);
    210  1.2.18.2  yamt 
    211  1.2.18.2  yamt 	/* INCrement */
    212  1.2.18.2  yamt 	hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr & ~PSH3LCD_CONTRAST_INC);
    213  1.2.18.2  yamt 	delay(1);
    214  1.2.18.2  yamt 	hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr);
    215  1.2.18.2  yamt 	delay(1);
    216  1.2.18.2  yamt 
    217  1.2.18.2  yamt 	/* CS deassert */
    218  1.2.18.2  yamt 	gpadr |= PSH3LCD_CONTRAST_CS;
    219  1.2.18.2  yamt 	hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr);
    220  1.2.18.2  yamt 	delay(1);
    221  1.2.18.2  yamt }
    222  1.2.18.2  yamt 
    223  1.2.18.3  yamt /* ARGSUSED */
    224  1.2.18.2  yamt static int
    225  1.2.18.3  yamt psh3lcd_match(struct device *parent __unused, struct cfdata *cfp,
    226  1.2.18.3  yamt 	      void *aux __unused)
    227  1.2.18.2  yamt {
    228  1.2.18.2  yamt 	uint8_t bcr0;
    229  1.2.18.2  yamt 
    230  1.2.18.2  yamt 	if (!platid_match(&platid, &platid_mask_MACH_HITACHI_PERSONA))
    231  1.2.18.3  yamt 		return 0;
    232  1.2.18.2  yamt 
    233  1.2.18.2  yamt 	if (strcmp(cfp->cf_name, "psh3lcd") != 0)
    234  1.2.18.3  yamt 		return 0;
    235  1.2.18.2  yamt 
    236  1.2.18.2  yamt 	bcr0 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG0);
    237  1.2.18.2  yamt 	if (bcr0 == 0) {
    238  1.2.18.2  yamt 		if (psh3lcd_xx0_bcd_get() == BCD_NO_MATCH)
    239  1.2.18.3  yamt 			return 0;
    240  1.2.18.2  yamt 	} else {
    241  1.2.18.2  yamt 		if (psh3lcd_x0_bcd_get() == BCD_NO_MATCH)
    242  1.2.18.3  yamt 			return 0;
    243  1.2.18.2  yamt 	}
    244  1.2.18.2  yamt 
    245  1.2.18.3  yamt 	return 1;
    246  1.2.18.2  yamt }
    247  1.2.18.2  yamt 
    248  1.2.18.3  yamt /* ARGSUSED */
    249  1.2.18.2  yamt static void
    250  1.2.18.3  yamt psh3lcd_attach(struct device *parent __unused, struct device *self,
    251  1.2.18.3  yamt 	       void *aux __unused)
    252  1.2.18.2  yamt {
    253  1.2.18.3  yamt 	struct psh3lcd_softc *sc = device_private(self);
    254  1.2.18.2  yamt 	uint8_t bcr0, bcr1, bcr2;
    255  1.2.18.2  yamt 
    256  1.2.18.2  yamt 	bcr0 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG0);
    257  1.2.18.2  yamt 	bcr1 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG1);
    258  1.2.18.2  yamt 	bcr2 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG2);
    259  1.2.18.2  yamt 	if (bcr0 == 0) {
    260  1.2.18.2  yamt 		sc->sc_set_brightness = psh3lcd_xx0_set_brightness;
    261  1.2.18.2  yamt 		sc->sc_brightness = psh3lcd_xx0_bcd_get();
    262  1.2.18.2  yamt 		sc->sc_brightness_max = PSH3LCD_XX0_BRIGHTNESS_MAX;
    263  1.2.18.2  yamt 	} else {
    264  1.2.18.2  yamt 		sc->sc_set_brightness = psh3lcd_x0_set_brightness;
    265  1.2.18.2  yamt 		sc->sc_brightness = psh3lcd_x0_bcd_get();
    266  1.2.18.2  yamt 		sc->sc_brightness_max = PSH3LCD_X0_BRIGHTNESS_MAX;
    267  1.2.18.2  yamt 	}
    268  1.2.18.3  yamt 	aprint_naive("\n");
    269  1.2.18.3  yamt 	aprint_normal(": brightness %d\n", sc->sc_brightness);
    270  1.2.18.2  yamt 
    271  1.2.18.2  yamt 	/* LCD contrast hooks */
    272  1.2.18.2  yamt         config_hook(CONFIG_HOOK_GET,
    273  1.2.18.2  yamt 	    CONFIG_HOOK_CONTRAST_MAX, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
    274  1.2.18.2  yamt         config_hook(CONFIG_HOOK_GET,
    275  1.2.18.2  yamt 	    CONFIG_HOOK_CONTRAST, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
    276  1.2.18.2  yamt         config_hook(CONFIG_HOOK_SET,
    277  1.2.18.2  yamt 	    CONFIG_HOOK_CONTRAST, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
    278  1.2.18.2  yamt 
    279  1.2.18.2  yamt 	/* LCD brightness hooks */
    280  1.2.18.2  yamt         config_hook(CONFIG_HOOK_GET,
    281  1.2.18.2  yamt 	    CONFIG_HOOK_BRIGHTNESS_MAX, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
    282  1.2.18.2  yamt         config_hook(CONFIG_HOOK_GET,
    283  1.2.18.2  yamt 	    CONFIG_HOOK_BRIGHTNESS, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
    284  1.2.18.2  yamt         config_hook(CONFIG_HOOK_SET,
    285  1.2.18.2  yamt 	    CONFIG_HOOK_BRIGHTNESS, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
    286  1.2.18.2  yamt 
    287  1.2.18.2  yamt 	/* LCD on/off hook */
    288  1.2.18.2  yamt 	config_hook(CONFIG_HOOK_POWERCONTROL,
    289  1.2.18.2  yamt 	    CONFIG_HOOK_POWERCONTROL_LCD, CONFIG_HOOK_SHARE, psh3lcd_power, sc);
    290  1.2.18.2  yamt }
    291  1.2.18.2  yamt 
    292  1.2.18.2  yamt 
    293  1.2.18.2  yamt static int
    294  1.2.18.2  yamt psh3lcd_param(void *ctx, int type, long id, void *msg)
    295  1.2.18.2  yamt {
    296  1.2.18.2  yamt 	struct psh3lcd_softc *sc = ctx;
    297  1.2.18.2  yamt 	int value;
    298  1.2.18.2  yamt 
    299  1.2.18.2  yamt 	switch (type) {
    300  1.2.18.2  yamt 	case CONFIG_HOOK_GET:
    301  1.2.18.2  yamt 		switch (id) {
    302  1.2.18.2  yamt 		case CONFIG_HOOK_CONTRAST:
    303  1.2.18.2  yamt 			*(int *)msg = PSH3LCD_CONTRAST;
    304  1.2.18.3  yamt 			return 0;
    305  1.2.18.2  yamt 
    306  1.2.18.2  yamt 		case CONFIG_HOOK_CONTRAST_MAX:
    307  1.2.18.2  yamt 			*(int *)msg = PSH3LCD_CONTRAST_MAX;
    308  1.2.18.3  yamt 			return 0;
    309  1.2.18.2  yamt 
    310  1.2.18.2  yamt 		case CONFIG_HOOK_BRIGHTNESS:
    311  1.2.18.2  yamt 			*(int *)msg = sc->sc_brightness;
    312  1.2.18.3  yamt 			return 0;
    313  1.2.18.2  yamt 
    314  1.2.18.2  yamt 		case CONFIG_HOOK_BRIGHTNESS_MAX:
    315  1.2.18.2  yamt 			*(int *)msg = sc->sc_brightness_max;
    316  1.2.18.3  yamt 			return 0;
    317  1.2.18.2  yamt 		}
    318  1.2.18.2  yamt 		break;
    319  1.2.18.2  yamt 
    320  1.2.18.2  yamt 	case CONFIG_HOOK_SET:
    321  1.2.18.2  yamt 		value = *(int *)msg;
    322  1.2.18.2  yamt 
    323  1.2.18.2  yamt 		switch (id) {
    324  1.2.18.2  yamt 		case CONFIG_HOOK_CONTRAST:
    325  1.2.18.2  yamt 			if (value != PSH3LCD_CONTRAST_UP &&
    326  1.2.18.2  yamt 			    value != PSH3LCD_CONTRAST_DOWN)
    327  1.2.18.3  yamt 				return EINVAL;
    328  1.2.18.2  yamt 			psh3lcd_set_contrast(value);
    329  1.2.18.3  yamt 			return 0;
    330  1.2.18.2  yamt 
    331  1.2.18.2  yamt 		case CONFIG_HOOK_BRIGHTNESS:
    332  1.2.18.2  yamt 			if (value < 0)
    333  1.2.18.2  yamt 				value = 0;
    334  1.2.18.2  yamt 			if (value > sc->sc_brightness_max)
    335  1.2.18.2  yamt 				value = sc->sc_brightness_max;
    336  1.2.18.2  yamt 			sc->sc_brightness = value;
    337  1.2.18.2  yamt 			sc->sc_set_brightness(sc->sc_brightness);
    338  1.2.18.3  yamt 			return 0;
    339  1.2.18.2  yamt 		}
    340  1.2.18.2  yamt 		break;
    341  1.2.18.2  yamt 	}
    342  1.2.18.2  yamt 
    343  1.2.18.3  yamt 	return EINVAL;
    344  1.2.18.2  yamt }
    345  1.2.18.2  yamt 
    346  1.2.18.2  yamt 
    347  1.2.18.2  yamt static int
    348  1.2.18.2  yamt psh3lcd_power(void *ctx, int type, long id, void *msg)
    349  1.2.18.2  yamt {
    350  1.2.18.2  yamt 	struct psh3lcd_softc *sc = ctx;
    351  1.2.18.2  yamt 	int on;
    352  1.2.18.2  yamt 
    353  1.2.18.2  yamt 	if (type != CONFIG_HOOK_POWERCONTROL ||
    354  1.2.18.2  yamt 	    id != CONFIG_HOOK_POWERCONTROL_LCD)
    355  1.2.18.3  yamt 		return EINVAL;
    356  1.2.18.2  yamt 
    357  1.2.18.2  yamt 	on = (int)msg;
    358  1.2.18.2  yamt 	if (on)
    359  1.2.18.2  yamt 		sc->sc_set_brightness(sc->sc_brightness);
    360  1.2.18.2  yamt 	else
    361  1.2.18.2  yamt 		sc->sc_set_brightness(sc->sc_brightness_max + 1);
    362  1.2.18.2  yamt 
    363  1.2.18.3  yamt 	return 0;
    364  1.2.18.2  yamt }
    365