/*
sysfs input, to set the current videomode
*/
static ssize_t bmi_video_vmode_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t len)
{
struct bmi_video *video = dev_get_drvdata(dev);
int err = 0;
if (strstr(buf, "dvi") != NULL || strstr(buf, "DVI") != NULL){
err = scan_for_monitors(DVI, video);
if(err) {
printk(KERN_ERR "scan_for_monitors DVI err %d",err);
return len;
}
enable_dvi(video);
}
else if (strstr(buf, "vga") != NULL || strstr(buf, "VGA") != NULL){
err = scan_for_monitors(VGA, video);
if(err) {
printk(KERN_ERR "scan_for_monitors VGA err %d",err);
return len;
}
enable_vga(video);
}
else if (strstr(buf, "auto") != NULL || strstr(buf, "AUTO") != NULL){
err = scan_for_monitors(AUTO, video);
if(err) {
printk(KERN_ERR "scan_for_monitors err %d",err);
return len;
}
if(video->dvi_monitor_edid) {
//printk(KERN_INFO "dvi monitor detected");
enable_dvi(video);
}
else if(video->vga_monitor_edid) {
//printk(KERN_INFO "vga monitor detected");
enable_vga(video);
}
else {
printk(KERN_INFO "no monitor detected");
monitors_off(video);
}
}
//test functions
else if (strstr(buf, "t1") != NULL){
ths8200_reset(VGA_RESET_GPIO,video->vga_controller);
tfp410_disable(video->dvi_controller);
}
else if (strstr(buf, "t2") != NULL){
ths8200_reset(VGA_RESET_GPIO,video->vga_controller);
tfp410_enable(video->dvi_controller);
}
else if (strstr(buf, "t3") != NULL){
ths8200_enable(video->vga_controller);
}
else if (strstr(buf, "t4") != NULL){
ths8200_disable(video->vga_controller);
}
else if (strstr(buf, "t5") != NULL){
ths8200_init(video->vga_controller);
}
else if (strstr(buf, "off") != NULL || strstr(buf, "OFF") != NULL){
ths8200_reset(VGA_RESET_GPIO,video->vga_controller);
tfp410_disable(video->dvi_controller);
ths8200_disable(video->vga_controller);
}
return len;
}
static void lcdc_io_init_component(unsigned char lcdc_num, unsigned char type)
{
unsigned int lcd_reg = 0;
unsigned int width, height;
stCOMPONENT_SPEC spec;
stLTIMING ComponentTiming;
stLCDCTR LcdCtrlParam;
PVIOC_DISP pDISPBase;
PVIOC_WMIX pWIXBase;
PDDICONFIG pDDICfg = (PDDICONFIG)HwDDI_CONFIG_BASE;
PNTSCPAL pTVE = (PNTSCPAL)HwNTSCPAL_BASE;
PGPIO pGPIO = (PGPIO)HwGPIO_BASE;
struct fbcon_config *fb_con;
printf("%s, lcdc_num=%d, type=%d\n", __func__, lcdc_num, type);
if(type >= LCDC_COMPONENT_MAX)
type = defalut_component_resolution;
#if defined(COMPONENT_CHIP_THS8200)
#if defined(TARGET_BOARD_STB)
/* THS8200 Power Control - GPIO_F16 */
gpio_set(TCC_GPF(16), 1);
#else
#endif
#endif
#ifndef DEFAULT_DISPLAY_OUTPUT_DUAL
BITSET(pTVE->DACPD, HwTVEDACPD_PD_EN);
#endif
component_get_spec(type, &spec);
LCDC_IO_Set(lcdc_num, spec.component_bus_width);
fb_con = &fb_cfg;
if(lcdc_num)
{
pDISPBase = (VIOC_DISP *)HwVIOC_DISP1;
pWIXBase =(VIOC_WMIX *)HwVIOC_WMIX1;
tca_ckc_setperi(PERI_LCD1, ENABLE, spec.component_clock*spec.component_divider);
//VIOC_OUTCFG_SetOutConfig(VIOC_OUTCFG_MRGB, VIOC_OUTCFG_DISP1);
}
else
{
pDISPBase = (VIOC_DISP *)HwVIOC_DISP0;
pWIXBase =(VIOC_WMIX *)HwVIOC_WMIX0;
tca_ckc_setperi(PERI_LCD0, ENABLE, spec.component_clock*spec.component_divider);
//VIOC_OUTCFG_SetOutConfig(VIOC_OUTCFG_MRGB, VIOC_OUTCFG_DISP0);
}
printf("LCDC0 clk:%d, LCDC1 clk:%d, PLL:%d, divide:%d\n", tca_ckc_getperi(PERI_LCD0), tca_ckc_getperi(PERI_LCD1), tca_ckc_getpll(PCDIRECTPLL0), spec.component_divider);
width = spec.component_width;
height = spec.component_height;
lcdc_set_logo(lcdc_num, width, height, fb_con);
ComponentTiming.lpw = spec.component_LPW;
ComponentTiming.lpc = spec.component_LPC + 1;
ComponentTiming.lswc = spec.component_LSWC + 1;
ComponentTiming.lewc = spec.component_LEWC + 1;
ComponentTiming.vdb = spec.component_VDB;
ComponentTiming.vdf = spec.component_VDF;
ComponentTiming.fpw = spec.component_FPW1;
ComponentTiming.flc = spec.component_FLC1;
ComponentTiming.fswc = spec.component_FSWC1;
ComponentTiming.fewc = spec.component_FEWC1;
ComponentTiming.fpw2 = spec.component_FPW2;
ComponentTiming.flc2 = spec.component_FLC2;
ComponentTiming.fswc2 = spec.component_FSWC2;
ComponentTiming.fewc2 = spec.component_FEWC2;
VIOC_DISP_SetTimingParam(pDISPBase, &ComponentTiming);
memset(&LcdCtrlParam, NULL, sizeof(LcdCtrlParam));
switch(type)
{
case LCDC_COMPONENT_480I_NTSC:
case LCDC_COMPONENT_576I_PAL:
break;
case LCDC_COMPONENT_720P:
LcdCtrlParam.r2ymd = 3;
LcdCtrlParam.ckg = 1;
LcdCtrlParam.id= 0;
LcdCtrlParam.iv = 1;
LcdCtrlParam.ih = 1;
LcdCtrlParam.ip = 0;
LcdCtrlParam.pxdw = 12;
LcdCtrlParam.ni = 1;
break;
case LCDC_COMPONENT_1080I:
LcdCtrlParam.r2ymd = 3;
LcdCtrlParam.ckg = 1;
LcdCtrlParam.id= 1;
LcdCtrlParam.iv = 1;
LcdCtrlParam.ih = 0;
LcdCtrlParam.ip = 1;
LcdCtrlParam.pxdw = 12;
LcdCtrlParam.ni = 0;
LcdCtrlParam.tv = 1;
break;
default:
break;
}
VIOC_DISP_SetControlConfigure(pDISPBase, &LcdCtrlParam);
VIOC_DISP_SetSize(pDISPBase, width, height);
VIOC_DISP_SetBGColor(pDISPBase, 0, 0 , 0);
VIOC_WMIX_SetOverlayPriority(pWIXBase, 0);
VIOC_WMIX_SetBGColor(pWIXBase, 0x00, 0x00, 0x00, 0xff);
VIOC_WMIX_SetSize(pWIXBase, width, height);
VIOC_WMIX_SetUpdate(pWIXBase);
#if defined(TARGET_BOARD_STB)
/* VE_FIELD: GPIO_E27 */
gpio_config(TCC_GPE(27), GPIO_FN0|GPIO_OUTPUT|GPIO_HIGH);
#endif
/* Enable Component Chip */
#if defined(COMPONENT_CHIP_CS4954)
if(type == LCDC_COMPONENT_480I_NTSC)
cs4954_enable(COMPONENT_MODE_NTSC_M); // NTSC_M
else
cs4954_enable(COMPONENT_MODE_PAL_B); // PAL_B
#elif defined(COMPONENT_CHIP_THS8200)
if(type == LCDC_COMPONENT_720P)
ths8200_enable(COMPONENT_MODE_720P); // 720P
else
ths8200_enable(COMPONENT_MODE_1080I); // 1080I
#endif
VIOC_DISP_TurnOn(pDISPBase);
}
