static ssize_t store_dbg(struct device * dev, struct device_attribute *attr, const char * buf, size_t count) { char tmpbuf[128]; int i=0; unsigned int adr; unsigned int value=0; while((buf[i])&&(buf[i]!=',')&&(buf[i]!=' ')){ tmpbuf[i]=buf[i]; i++; } tmpbuf[i]=0; if(strncmp(tmpbuf, "config_dvin", 11)==0){ #ifdef DEBUG_DVIN config_dvin (hs_pol_inv, vs_pol_inv, de_pol_inv, field_pol_inv, ext_field_sel, de_mode, data_comp_map, mode_422to444, dvin_clk_inv, vs_hs_tim_ctrl, hs_lead_vs_odd_min, hs_lead_vs_odd_max, active_start_pix_fe, active_start_pix_fo, active_start_line_fe, active_start_line_fo, line_width, field_height); #endif } else if(strncmp(tmpbuf, "pause", 5)==0){ hdmirx_device.task_pause = 1; printk("Pause %s\n", __func__); } else if(strncmp(tmpbuf, "start", 5)==0){ hdmirx_device.task_pause = 0; printk("Start %s\n", __func__); } else if(strncmp(tmpbuf, "spdif", 5)==0){ setHDMIRX_SPDIFOutput(); } else if(strncmp(tmpbuf, "i2s", 3)==0){ setHDMIRX_I2SOutput(0x1); } else if(strncmp(tmpbuf, "hpd", 3)==0){ if(tmpbuf[3]=='0'){ CLEAR_HPD; } else if(tmpbuf[3]=='1'){ SET_HPD; } } else if(tmpbuf[0]=='w'){ adr=simple_strtoul(tmpbuf+2, NULL, 16); value=simple_strtoul(buf+i+1, NULL, 16); if(buf[1]=='h'){ HDMIRX_WriteI2C_Byte(adr, value); } else if(buf[1]=='c'){ WRITE_MPEG_REG(adr, value); pr_info("write %x to CBUS reg[%x]\n",value,adr); } else if(buf[1]=='p'){ WRITE_APB_REG(adr, value); pr_info("write %x to APB reg[%x]\n",value,adr); } } else if(tmpbuf[0]=='r'){ adr=simple_strtoul(tmpbuf+2, NULL, 16); if(buf[1]=='h'){ value = HDMIRX_ReadI2C_Byte(adr); pr_info("HDMI reg[%x]=%x\n", adr, value); } else if(buf[1]=='c'){ value = READ_MPEG_REG(adr); pr_info("CBUS reg[%x]=%x\n", adr, value); } else if(buf[1]=='p'){ value = READ_APB_REG(adr); pr_info("APB reg[%x]=%x\n", adr, value); } } return 16; }
static void start_vdin(int width, int height, int frame_rate, int field_flag) { tvin_parm_t para; if(hdmirx_device.vdin_enable == 0){ return; } if(hdmirx_device.vdin_started){ if(hdmirx_device.cur_width != width || hdmirx_device.cur_height != height || hdmirx_device.cur_frame_rate != frame_rate){ stop_tvin_service(0); hdmirx_device.vdin_started=0; printk("%s: stop vdin\n", __func__); } } if(hdmirx_device.vdin_started==0 && width>0 && height>0 && frame_rate >0){ hdmirx_device.cur_width = width; hdmirx_device.cur_height = height; hdmirx_device.cur_frame_rate = frame_rate; #ifdef DEBUG_DVIN hs_pol_inv = 0; vs_pol_inv = height>480?0:1; de_pol_inv = 0; field_pol_inv = 0; ext_field_sel = 0; de_mode = 0; data_comp_map = 0; mode_422to444 = 0; dvin_clk_inv = 0; vs_hs_tim_ctrl = 0; hs_lead_vs_odd_min = 0; hs_lead_vs_odd_max = 0; active_start_pix_fe = getHDMIRXHorzBackPorch(); active_start_pix_fo = getHDMIRXHorzBackPorch(); active_start_line_fe = getHDMIRXVertSyncBackPorch(); active_start_line_fo = getHDMIRXVertSyncBackPorch(); line_width = getHDMIRXHorzTotal(); field_height = getHDMIRXVertTotal(); #endif if(field_flag && height <= 480 ){ config_dvin(0, //hs_pol_inv, 1, //vs_pol_inv, 0, //de_pol_inv, 0, //field_pol_inv, 0, //ext_field_sel, 2, //de_mode, 0, //data_comp_map, 0, //mode_422to444, 0, //dvin_clk_inv, 0, //vs_hs_tim_ctrl, 400, //hs_lead_vs_odd_min, 1200, //hs_lead_vs_odd_max, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fe, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fo, getHDMIRXVertSyncBackPorch(), //0x19, //active_start_line_fe, getHDMIRXVertSyncBackPorch(),//0x19, //active_start_line_fo, getHDMIRXHorzTotal(), //0x672, //line_width, getHDMIRXVertTotal() //0x2ee //field_height ); } else{ config_dvin(0, //hs_pol_inv, height>480?0:1, //vs_pol_inv, 0, //de_pol_inv, 0, //field_pol_inv, 0, //ext_field_sel, 0, //de_mode, 0, //data_comp_map, 0, //mode_422to444, 0, //dvin_clk_inv, 0, //vs_hs_tim_ctrl, 0, //hs_lead_vs_odd_min, 0, //hs_lead_vs_odd_max, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fe, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fo, getHDMIRXVertSyncBackPorch(), //0x19, //active_start_line_fe, getHDMIRXVertSyncBackPorch(),//0x19, //active_start_line_fo, getHDMIRXHorzTotal(), //0x672, //line_width, getHDMIRXVertTotal() //0x2ee //field_height ); } para.fmt_info.h_active = hdmirx_device.cur_width; para.fmt_info.v_active = hdmirx_device.cur_height; para.port = TVIN_PORT_DVIN0; if(field_flag){ para.fmt_info.v_active <<= 1; //if(height == 1080){ para.fmt_info.fmt = TVIN_SIG_FMT_HDMI_1920x1080I_60Hz; //} //else{ // para.fmt_info.fmt = TVIN_SIG_FMT_HDMI_1440x480I_60Hz; //} } else{ para.fmt_info.fmt = TVIN_SIG_FMT_MAX+1;//TVIN_SIG_FMT_MAX+1;TVIN_SIG_FMT_CAMERA_1280X720P_30Hz } para.fmt_info.frame_rate = frame_rate; para.fmt_info.hsync_phase = 1; para.fmt_info.vsync_phase = 0; start_tvin_service(0,¶); hdmirx_device.vdin_started = 1; printk("%s: %dx%d %d/s\n", __func__, width, height, frame_rate); hdmirx_device.aud_info.real_sample_rate = audio_sample_freq; #ifdef CONFIG_AML_AUDIO_DSP mailbox_send_audiodsp(1, M2B_IRQ0_DSP_AUDIO_EFFECT, DSP_CMD_SET_HDMI_SR, (char *)&hdmirx_device.aud_info.real_sample_rate,sizeof(hdmirx_device.aud_info.real_sample_rate)); printk("[IT660x]%s: mailbox_send_audiodsp %d\n",__func__, hdmirx_device.aud_info.real_sample_rate); #endif } }
static void start_vdin(int width, int height, int frame_rate, int field_flag) { #ifdef USE_TVIN_CAMERA tvin_parm_t para; #else vdin_parm_t para; #endif if(hdmirx_device.vdin_enable == 0){ return; } if(hdmirx_device.vdin_started){ if(hdmirx_device.cur_width != width || hdmirx_device.cur_height != height || hdmirx_device.cur_frame_rate != frame_rate){ stop_tvin_service(0); hdmirx_device.vdin_started=0; printk("%s: stop vdin\n", __func__); } } if(hdmirx_device.vdin_started==0 && width>0 && height>0 && frame_rate >0){ hdmirx_device.cur_width = width; hdmirx_device.cur_height = height; hdmirx_device.cur_frame_rate = frame_rate; if(field_flag && height <= (576/2) ){ config_dvin(0, //hs_pol_inv, 1, //vs_pol_inv, 0, //de_pol_inv, 0, //field_pol_inv, 0, //ext_field_sel, 3, //de_mode, 0, //data_comp_map, 0, //mode_422to444, 0, //dvin_clk_inv, 0, //vs_hs_tim_ctrl, 400, //hs_lead_vs_odd_min, 1200, //hs_lead_vs_odd_max, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fe, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fo, getHDMIRXVertSyncBackPorch(), //0x19, //active_start_line_fe, getHDMIRXVertSyncBackPorch(),//0x19, //active_start_line_fo, getHDMIRXHorzTotal(), //0x672, //line_width, getHDMIRXVertTotal() //0x2ee //field_height ); } else{ config_dvin(0, //hs_pol_inv, (field_flag && height>=540)?0:(height>576?0:1), //vs_pol_inv, 0, //de_pol_inv, (field_flag && height>=540)?1:0, //field_pol_inv, set to 1 for 1080i 0, //ext_field_sel, 3, //de_mode, 0, //data_comp_map, 0, //mode_422to444, 0, //dvin_clk_inv, 0, //vs_hs_tim_ctrl, 0, //hs_lead_vs_odd_min, 0, //hs_lead_vs_odd_max, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fe, getHDMIRXHorzBackPorch(),//0xdc, //active_start_pix_fo, getHDMIRXVertSyncBackPorch(), //0x19, //active_start_line_fe, getHDMIRXVertSyncBackPorch(),//0x19, //active_start_line_fo, getHDMIRXHorzTotal(), //0x672, //line_width, getHDMIRXVertTotal() //0x2ee //field_height ); } #ifdef USE_TVIN_CAMERA para.fmt_info.h_active = hdmirx_device.cur_width; para.fmt_info.v_active = hdmirx_device.cur_height; para.port = TVIN_PORT_DVIN0; if(field_flag){ para.fmt_info.v_active <<= 1; //if(height == 1080){ para.fmt_info.fmt = TVIN_SIG_FMT_HDMI_1920x1080I_60Hz; //} //else{ // para.fmt_info.fmt = TVIN_SIG_FMT_HDMI_1440x480I_60Hz; //} } else{ para.fmt_info.fmt = TVIN_SIG_FMT_MAX+1;//TVIN_SIG_FMT_MAX+1;TVIN_SIG_FMT_CAMERA_1280X720P_30Hz } para.fmt_info.frame_rate = frame_rate; para.fmt_info.hsync_phase = 1; para.fmt_info.vsync_phase = 0; #else memset( ¶, 0, sizeof(para)); para.port = TVIN_PORT_DVIN0; para.frame_rate = frame_rate; para.h_active = hdmirx_device.cur_width; para.v_active = hdmirx_device.cur_height; if(field_flag){ if(hdmirx_device.cur_width == 1920 && (hdmirx_device.cur_height == 1080 || hdmirx_device.cur_height == 540)){ para.fmt = TVIN_SIG_FMT_HDMI_1920X1080I_60HZ; para.v_active = 1080; } /* else if( hdmirx_device.cur_width == 720 && (hdmirx_device.cur_height == 576 || hdmirx_device.cur_height == 288)){ para.fmt = TVIN_SIG_FMT_HDMI_720X576I_50HZ; para.v_active = 576; set_invert_top_bot(true); } else if(hdmirx_device.cur_width == 1440 && (hdmirx_device.cur_height == 576 || hdmirx_device.cur_height == 288)){ para.fmt = TVIN_SIG_FMT_HDMI_1440X576I_50HZ; para.v_active = 576; set_invert_top_bot(true); } else if( hdmirx_device.cur_width == 720 && (hdmirx_device.cur_height == 480 || hdmirx_device.cur_height == 240)){ para.fmt = TVIN_SIG_FMT_HDMI_720X480I_60HZ; para.v_active = 480; set_invert_top_bot(true); } else if(hdmirx_device.cur_width == 1440 && (hdmirx_device.cur_height == 480 || hdmirx_device.cur_height == 240)){ para.fmt = TVIN_SIG_FMT_HDMI_1440X480I_60HZ; para.v_active = 480; set_invert_top_bot(true); }*/ else{ para.fmt = TVIN_SIG_FMT_MAX+1; set_invert_top_bot(true); } para.scan_mode = TVIN_SCAN_MODE_INTERLACED; } else{ if(hdmirx_device.cur_width == 1920 && hdmirx_device.cur_height == 1080){ para.fmt = TVIN_SIG_FMT_HDMI_1920X1080P_60HZ; } else if(hdmirx_device.cur_width == 1280 && hdmirx_device.cur_height == 720){ para.fmt = TVIN_SIG_FMT_HDMI_1280X720P_60HZ; } else if((hdmirx_device.cur_width == 1440 || hdmirx_device.cur_width == 720) && hdmirx_device.cur_height == 576){ para.fmt = TVIN_SIG_FMT_HDMI_720X576P_50HZ; } else if((hdmirx_device.cur_width == 1440 || hdmirx_device.cur_width == 720) && hdmirx_device.cur_height == 480){ para.fmt = TVIN_SIG_FMT_HDMI_720X480P_60HZ; } else{ para.fmt = TVIN_SIG_FMT_MAX+1; } para.scan_mode = TVIN_SCAN_MODE_PROGRESSIVE; } para.hsync_phase = 1; para.vsync_phase = 0; //para.hs_bp = 0; //para.vs_bp = 2; para.cfmt = TVIN_RGB444; para.reserved = 0; //skip_num #endif start_tvin_service(0,¶); hdmirx_device.vdin_started = 1; printk("%s: %dx%d %d/s\n", __func__, width, height, frame_rate); hdmirx_device.aud_info.real_sample_rate = audio_sample_freq; #ifdef CONFIG_AML_AUDIO_DSP mailbox_send_audiodsp(1, M2B_IRQ0_DSP_AUDIO_EFFECT, DSP_CMD_SET_HDMI_SR, (char *)&hdmirx_device.aud_info.real_sample_rate,sizeof(hdmirx_device.aud_info.real_sample_rate)); printk("[IT660x]%s: mailbox_send_audiodsp %d\n",__func__, hdmirx_device.aud_info.real_sample_rate); #endif } }