#include <sys/cdefs.h>
#include <sys/types.h>
#include <sys/param.h>
#include <sys/device.h>
#include <sys/errno.h>
#include <sys/kernel.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <machine/platid.h>
#include <machine/platid_mask.h>
#include <machine/config_hook.h>
#include <sh3/pfcreg.h>
#include <hpcsh/dev/hd64461/hd64461var.h>
#include <hpcsh/dev/hd64461/hd64461reg.h>
#include <hpcsh/dev/hd64461/hd64461gpioreg.h>
#define PSH3LCD_CONTRAST_INC 0x01
#define PSH3LCD_CONTRAST_CS 0x02
#define PSH3LCD_CONTRAST_UD 0x01
#define PSH3LCD_BRIGHTNESS_REG0 0xaa000072
#define PSH3LCD_BRIGHTNESS_REG1 0xaa000150
#define PSH3LCD_BRIGHTNESS_REG2 0xaa000152
static const struct psh3lcd_x0_bcd {
uint8_t reg0;
uint8_t reg1;
uint8_t reg2;
} psh3lcd_x0_bcd[] = {
{ 0x05, 0x08, 0x1e },
{ 0x05, 0x1d, 0x09 },
{ 0x04, 0x1e, 0x1e },
{ 0x06, 0x1e, 0x1e },
{ 0x07, 0x1e, 0x1e },
{ 0x00, 0x00, 0x00 }
};
static const struct psh3lcd_xx0_bcd {
uint8_t reg1;
uint8_t reg2;
} psh3lcd_xx0_bcd[] = {
{ 0x33, 0x0c },
{ 0x2d, 0x12 },
{ 0x26, 0x19 },
{ 0x20, 0x1f },
{ 0x1a, 0x25 },
{ 0x13, 0x2c },
{ 0x0d, 0x32 },
{ 0x07, 0x38 },
{ 0x01, 0x00 },
{ 0x00, 0x00 }
};
#define PSH3LCD_XX0_BRIGHTNESS_MAX 8
#define PSH3LCD_X0_BRIGHTNESS_MAX 4
#define PSH3LCD_CONTRAST_MAX 2
#define PSH3LCD_CONTRAST 1
#define PSH3LCD_CONTRAST_UP 2
#define PSH3LCD_CONTRAST_DOWN 0
#define BCD_NO_MATCH (-1)
struct psh3lcd_softc {
device_t sc_dev;
int sc_brightness;
int sc_brightness_max;
void (*sc_set_brightness)(int);
};
static int psh3lcd_match(device_t, struct cfdata *, void *);
static void psh3lcd_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(psh3lcd, sizeof(struct psh3lcd_softc),
psh3lcd_match, psh3lcd_attach, NULL, NULL);
static inline int psh3lcd_x0_bcd_get(void);
static inline int psh3lcd_xx0_bcd_get(void);
static void psh3lcd_x0_set_brightness(int);
static void psh3lcd_xx0_set_brightness(int);
static void psh3lcd_set_contrast(int);
static int psh3lcd_param(void *, int, long, void *);
static int psh3lcd_power(void *, int, long, void *);
static inline int
psh3lcd_x0_bcd_get(void)
{
int i;
uint8_t bcr0, bcr1, bcr2;
bcr0 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG0);
bcr1 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG1);
bcr2 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG2);
for (i = 0; psh3lcd_x0_bcd[i].reg0 != 0; i++)
if (bcr0 == psh3lcd_x0_bcd[i].reg0 &&
bcr1 == psh3lcd_x0_bcd[i].reg1 &&
bcr2 == psh3lcd_x0_bcd[i].reg2)
break;
if (psh3lcd_x0_bcd[i].reg0 == 0)
return BCD_NO_MATCH;
return i;
}
static inline int
psh3lcd_xx0_bcd_get(void)
{
int i;
uint8_t bcr1, bcr2;
bcr1 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG1);
bcr2 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG2);
for (i = 0; psh3lcd_xx0_bcd[i].reg1 != 0; i++)
if (bcr1 == psh3lcd_xx0_bcd[i].reg1 &&
bcr2 == psh3lcd_xx0_bcd[i].reg2)
break;
if (psh3lcd_xx0_bcd[i].reg1 == 0)
return BCD_NO_MATCH;
return i;
}
static void
psh3lcd_xx0_set_brightness(int index)
{
_reg_write_1(PSH3LCD_BRIGHTNESS_REG1, psh3lcd_xx0_bcd[index].reg1);
_reg_write_1(PSH3LCD_BRIGHTNESS_REG2, psh3lcd_xx0_bcd[index].reg2);
}
static void
psh3lcd_x0_set_brightness(int index)
{
_reg_write_1(PSH3LCD_BRIGHTNESS_REG0, psh3lcd_x0_bcd[index].reg0);
_reg_write_1(PSH3LCD_BRIGHTNESS_REG1, psh3lcd_x0_bcd[index].reg1);
_reg_write_1(PSH3LCD_BRIGHTNESS_REG2, psh3lcd_x0_bcd[index].reg2);
}
inline void
psh3lcd_set_contrast(int value)
{
uint16_t gpadr;
uint8_t pddr;
gpadr = hd64461_reg_read_2(HD64461_GPADR_REG16);
gpadr &= ~PSH3LCD_CONTRAST_CS;
hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr);
delay(1);
pddr = _reg_read_1(SH7709_PDDR);
if (value == PSH3LCD_CONTRAST_UP)
pddr |= PSH3LCD_CONTRAST_UD;
else if (value == PSH3LCD_CONTRAST_DOWN)
pddr &= ~PSH3LCD_CONTRAST_UD;
_reg_write_1(SH7709_PDDR, pddr);
delay(3);
hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr & ~PSH3LCD_CONTRAST_INC);
delay(1);
hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr);
delay(1);
gpadr |= PSH3LCD_CONTRAST_CS;
hd64461_reg_write_2(HD64461_GPADR_REG16, gpadr);
delay(1);
}
static int
psh3lcd_match(device_t parent __unused, struct cfdata *cfp, void *aux __unused)
{
uint8_t bcr0;
if (!platid_match(&platid, &platid_mask_MACH_HITACHI_PERSONA))
return 0;
if (strcmp(cfp->cf_name, "psh3lcd") != 0)
return 0;
bcr0 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG0);
if (bcr0 == 0) {
if (psh3lcd_xx0_bcd_get() == BCD_NO_MATCH)
return 0;
} else {
if (psh3lcd_x0_bcd_get() == BCD_NO_MATCH)
return 0;
}
return 1;
}
static void
psh3lcd_attach(device_t parent __unused, device_t self, void *aux __unused)
{
struct psh3lcd_softc *sc = device_private(self);
uint8_t bcr0;
sc->sc_dev = self;
bcr0 = _reg_read_1(PSH3LCD_BRIGHTNESS_REG0);
(void)_reg_read_1(PSH3LCD_BRIGHTNESS_REG1);
(void)_reg_read_1(PSH3LCD_BRIGHTNESS_REG2);
if (bcr0 == 0) {
sc->sc_set_brightness = psh3lcd_xx0_set_brightness;
sc->sc_brightness = psh3lcd_xx0_bcd_get();
sc->sc_brightness_max = PSH3LCD_XX0_BRIGHTNESS_MAX;
} else {
sc->sc_set_brightness = psh3lcd_x0_set_brightness;
sc->sc_brightness = psh3lcd_x0_bcd_get();
sc->sc_brightness_max = PSH3LCD_X0_BRIGHTNESS_MAX;
}
aprint_naive("\n");
aprint_normal(": brightness %d\n", sc->sc_brightness);
config_hook(CONFIG_HOOK_GET,
CONFIG_HOOK_CONTRAST_MAX, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
config_hook(CONFIG_HOOK_GET,
CONFIG_HOOK_CONTRAST, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
config_hook(CONFIG_HOOK_SET,
CONFIG_HOOK_CONTRAST, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
config_hook(CONFIG_HOOK_GET,
CONFIG_HOOK_BRIGHTNESS_MAX, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
config_hook(CONFIG_HOOK_GET,
CONFIG_HOOK_BRIGHTNESS, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
config_hook(CONFIG_HOOK_SET,
CONFIG_HOOK_BRIGHTNESS, CONFIG_HOOK_SHARE, psh3lcd_param, sc);
config_hook(CONFIG_HOOK_POWERCONTROL,
CONFIG_HOOK_POWERCONTROL_LCD, CONFIG_HOOK_SHARE, psh3lcd_power, sc);
if (!pmf_device_register(self, NULL, NULL))
aprint_error_dev(self, "unable to establish power handler\n");
}
static int
psh3lcd_param(void *ctx, int type, long id, void *msg)
{
struct psh3lcd_softc *sc = ctx;
int value;
switch (type) {
case CONFIG_HOOK_GET:
switch (id) {
case CONFIG_HOOK_CONTRAST:
*(int *)msg = PSH3LCD_CONTRAST;
return 0;
case CONFIG_HOOK_CONTRAST_MAX:
*(int *)msg = PSH3LCD_CONTRAST_MAX;
return 0;
case CONFIG_HOOK_BRIGHTNESS:
*(int *)msg = sc->sc_brightness;
return 0;
case CONFIG_HOOK_BRIGHTNESS_MAX:
*(int *)msg = sc->sc_brightness_max;
return 0;
}
break;
case CONFIG_HOOK_SET:
value = *(int *)msg;
switch (id) {
case CONFIG_HOOK_CONTRAST:
if (value != PSH3LCD_CONTRAST_UP &&
value != PSH3LCD_CONTRAST_DOWN)
return EINVAL;
psh3lcd_set_contrast(value);
return 0;
case CONFIG_HOOK_BRIGHTNESS:
if (value < 0)
value = 0;
if (value > sc->sc_brightness_max)
value = sc->sc_brightness_max;
sc->sc_brightness = value;
sc->sc_set_brightness(sc->sc_brightness);
return 0;
}
break;
}
return EINVAL;
}
static int
psh3lcd_power(void *ctx, int type, long id, void *msg)
{
struct psh3lcd_softc *sc = ctx;
int on;
if (type != CONFIG_HOOK_POWERCONTROL ||
id != CONFIG_HOOK_POWERCONTROL_LCD)
return EINVAL;
on = (int)msg;
if (on)
sc->sc_set_brightness(sc->sc_brightness);
else
sc->sc_set_brightness(sc->sc_brightness_max + 1);
return 0;
}