mx51 TVOUT分析

TAG:

1397 static int __init enable_tve_setup(char *options)
1398 {
1399 g_enable_tve = true;
1400
1401 return 1;
1402 }
1403 __setup("tve", enable_tve_setup);

一般情况，freescale会推荐在kernel命令行参数中使能TVE, 这个函数就是处理kernel传入的参数

'init=/init androidboot.console=ttymxc0 di1_primary video=mxcdi1fb:YUV444, 720x576-i@50 tve'

1198 static int tve_probe(struct platform_device *pdev)

1199 {

1200 int ret, i, primary = 0;

1201 struct resource *res;

1202 struct tve_platform_data *plat_data = pdev->dev.platform_data;

1203 u32 conf_reg;

1204

1205 if (g_enable_tve == false)

1206 return -EPERM;

1207

1208 INIT_LIST_HEAD(&tve_modelist.list);

1209

1210 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

1211 if (res == NULL)

1212 return -ENOMEM;

1213

1214 tve.pdev = pdev;

1215 tve.base = ioremap(res->start, res->end - res->start);

1216

1217 tve.irq = platform_get_irq(pdev, 0);

1218 if (tve.irq < 0) {

1219 ret = tve.irq;

1220 goto err0;

1221 }

1222

1223 ret = request_irq(tve.irq, tve_detect_handler, 0, pdev->name, pdev);

1224 if (ret < 0)

1225 goto err0;

1226

1227 ret = device_create_file(&pdev->dev, &dev_attr_headphone);

1228 if (ret < 0)

1229 goto err1;

1230

1231 for (i = 0; i < num_registered_fb; i++) {

1232 if (strcmp(registered_fb[i]->fix.id, "DISP3 BG - DI1") == 0) {

1233 tve_fbi = registered_fb[i];

1234 if (i == 0) {

1235 pr_info("TVE as primary display\n");

1236 primary = 1;

1237 acquire_console_sem();

1238 fb_blank(tve_fbi, FB_BLANK_POWERDOWN);

1239 release_console_sem();

1240 }

1241 break;

1242 }

1243 }

1215 映射TVE寄存器地址到，结果保存到tve.base中

1217～1225 注册Cable Detect handler

1227 创建headphone属性文件，可以通过cat /sys/devices/platform/tve.0/headphone查看当前 cable 状态。

1231～1243 如果在kernel cmdline中指定了di1_primary，那么registered_fb[0] 的id就是"DISP3 BG - DI1"，此时关闭fb_blank

1257 ~ 1266 获取di1和TVE的时钟

1267 ~ 1269 设置TVE的时钟rate，设置tve_clk1为di1_clk的父亲，这样启动di1就会为tve时钟上电;

1269 使能tve clk，这样才能操作tve的寄存器。

1271 ~ 1278 获取tve 版本；根据tve 的版本，来选择要操作的寄存器集合，

1292 ~ 1306 video_modes PAL, NTSC, 720P 是rev1和rev2都支持的video mode，rev2支持其他集中模式，XGA和SXGA仅在53上支持。

1309 初始化一个动作队列，这个工作队列是用来处理cable detect

1310 ~ 1313 设置cable detect register

1325 已经操作完TVE的寄存器，可以关闭clk了

1327 注册一个notifier callback，这样在fb event事件发生时就可以调用这个callback

1334 TVE是primary frame buffer，所以要显示logo

1343 不知道为什么要设置为 var.yres * 3 以后回来再看

1348～1356 关闭frame buffer再打开frame buffer

1179 static int _tve_get_revision(void)
1180 {
1181     u32 conf_reg;
1182     u32 rev = 0;
1183
1184     /* find out TVE rev based on the base addr default value
1185      * can be used at the init/probe ONLY */
1186     conf_reg = __raw_readl(tve.base);
1187     switch (conf_reg) {
1188     case 0x00842000:
1189         rev = 1;
1190         break;
1191     case 0x00100000:
1192         rev = 2;
1193         break;
1194     }
1195     return rev;
1196 }

通过读取0xBASE_0000寄存器的初始缺省值来获取TVE的版本号

1147 static ssize_t show_headphone(struct device *dev,
1148         struct device_attribute *attr, char *buf)
1149 {
1150     int detect;
1151
1152     if (!enabled) {
1153         strcpy(buf, "tve power off\n");
1154         return strlen(buf);
1155     }
1156
1157     detect = tve_update_detect_status();
1158
1159     if (detect == 0)
1160         strcpy(buf, "none\n");
1161     else if (detect == 1)
1162         strcpy(buf, "cvbs\n");
1163     else if (detect == 2)
1164         strcpy(buf, "headset\n");
1165     else if (detect == 3)
1166         strcpy(buf, "component\n");
1167     else
1168         strcpy(buf, "svideo\n");
1169
1170     return strlen(buf);
1171 }
这个函数是一个sys接口的show函数，用来显示当前cable的插入状态，cat /sys/devices/platform/tve.0/headphone将显示相应状态

1157是真正的cable检测函数

632 static int tve_update_detect_status(void)

633 {

634 int old_detect = tve.detect;

635 u32 stat_lm, stat_sm, stat;

636 u32 int_ctl;

637 u32 cd_cont_reg;

638 u32 timeout = 40;

639 unsigned long lock_flags;

640

641 spin_lock_irqsave(&tve_lock, lock_flags);

642

643 if (!enabled) {

644 pr_warning("Warning: update tve status while it disabled!\n");

645 tve.detect = 0;

646 goto done;

647 }

648

649 int_ctl = __raw_readl(tve.base + tve_regs->tve_int_cont_reg);

650 cd_cont_reg = __raw_readl(tve.base + tve_regs->tve_cd_cont_reg);

651

652 if ((cd_cont_reg & 0x1) == 0) {

653 pr_warning("Warning: pls enable TVE CD first!\n");

654 goto done;

655 }

656

657 stat = __raw_readl(tve.base + tve_regs->tve_stat_reg);

658 while (((stat & CD_MON_END_INT) == 0) && (timeout > 0)) {

659 spin_unlock_irqrestore(&tve_lock, lock_flags);

660 msleep(2);

661 spin_lock_irqsave(&tve_lock, lock_flags);

662 timeout -= 2;

663 if (!enabled) {

664 pr_warning("Warning: update tve status while it disabled!\n");

665 tve.detect = 0;

666 goto done;

667 } else

668 stat = __raw_readl(tve.base + tve_regs->tve_stat_reg);

669 }

670 if (((stat & CD_MON_END_INT) == 0) && (timeout <= 0)) {

671 pr_warning("Warning: get detect result without CD_MON_END_INT!\n");

672 goto done;

673 }

674

675 stat = stat >> tve_reg_fields->cd_ch_stat_offset;

676 stat_lm = stat & (CD_CH_0_LM_ST | CD_CH_1_LM_ST | CD_CH_2_LM_ST);

677 if ((stat_lm == (CD_CH_0_LM_ST | CD_CH_1_LM_ST | CD_CH_2_LM_ST)) &&

678 ((stat & (CD_CH_0_SM_ST | CD_CH_1_SM_ST | CD_CH_2_SM_ST)) == 0)

679 ) {

680 tve.detect = 3;

681 tve.output_mode = YPBPR;

682 } else if ((stat_lm == (CD_CH_0_LM_ST | CD_CH_1_LM_ST)) &&

683 ((stat & (CD_CH_0_SM_ST | CD_CH_1_SM_ST)) == 0)) {

684 tve.detect = 4;

685 tve.output_mode = SVIDEO;

686 } else if (stat_lm == CD_CH_0_LM_ST) {

687 stat_sm = stat & CD_CH_0_SM_ST;

688 if (stat_sm != 0) {

689 /* headset */

690 tve.detect = 2;

691 tve.output_mode = TV_OFF;

692 } else {

693 tve.detect = 1;

694 tve.output_mode = CVBS0;

695 }

696 } else if (stat_lm == CD_CH_2_LM_ST) {

697 stat_sm = stat & CD_CH_2_SM_ST;

698 if (stat_sm != 0) {

699 /* headset */

700 tve.detect = 2;

701 tve.output_mode = TV_OFF;

702 } else {

703 tve.detect = 1;

704 tve.output_mode = CVBS2;

705 }

706 } else {

707 /* none */

708 tve.detect = 0;

709 tve.output_mode = TV_OFF;

710 }

711

712 tve_set_tvout_mode(tve.output_mode);

713

714 /* clear interrupt */

715 __raw_writel(CD_MON_END_INT | CD_LM_INT | CD_SM_INT,

716 tve.base + tve_regs->tve_stat_reg);

717

718 __raw_writel(int_ctl | CD_SM_INT | CD_LM_INT,

719 tve.base + tve_regs->tve_int_cont_reg);

720

721 if (old_detect != tve.detect)

722 sysfs_notify(&tve.pdev->dev.kobj, NULL, "headphone");

723

724 dev_dbg(&tve.pdev->dev, "detect = %d mode = %d\n",

725 tve.detect, tve.output_mode);

726 done:

727 spin_unlock_irqrestore(&tve_lock, lock_flags);

728 return tve.detect;

729 }

643 ~ 647 TVE当前是disable的，所以不会做检测，直接返回tve.detect=0

650 ~655 应该使能CD_EN

657 ~ 669 每2ms检测一次tve_stat_reg，直到CD_MON_END_INT发生或者timeout

670 ～ 673 无CD_MON_END_INT中断发生，返回

675～710 根据tve_state_reg中的CD_CH_x_LM_ST和CD_CH_x_SM_ST来决定cable的插入状态

712 tve_set_tvout_mode是根据当前的cable 状态来调整tve out 模式

715 ~ 717 清空tve_stat_reg的cable detect状态位，写1清空

718 ~ 719 使能CD_SM_INT和CD_LM_INT，检测 cable的插拔

721 ~ 722 上报headphone事件给poll这个headphone文件描述符的进程

913 int tve_fb_event(struct notifier_block *nb, unsigned long val, void *v)

914 {

915 struct fb_event *event = v;

916 struct fb_info *fbi = event->info;

917

918 if (strcmp(fbi->fix.id, "DISP3 BG - DI1"))

919 return 0;

920

921 switch (val) {

922 case FB_EVENT_FB_REGISTERED:

923 pr_debug("fb registered event\n");

924 if (tve_fbi != NULL)

925 break;

926

927 tve_fbi = fbi;

928 fb_add_videomode(&video_modes[0], &tve_modelist.list);

929 fb_add_videomode(&video_modes[1], &tve_modelist.list);

930 fb_add_videomode(&video_modes[2], &tve_modelist.list);

931 if (tve.revision == 2) {

932 fb_add_videomode(&video_modes[3], &tve_modelist.list);

933 fb_add_videomode(&video_modes[4], &tve_modelist.list);

934 fb_add_videomode(&video_modes[5], &tve_modelist.list);

935 fb_add_videomode(&video_modes[6], &tve_modelist.list);

936 fb_add_videomode(&video_modes[7], &tve_modelist.list);

937 fb_add_videomode(&video_modes[8], &tve_modelist.list);

938 if (cpu_is_mx53()) {

939 fb_add_videomode(&video_modes[9], &tve_modelist.list);

940 fb_add_videomode(&video_modes[10], &tve_modelist.list);

941 }

942 }

943 break;

944 case FB_EVENT_MODE_CHANGE:

945 {

946 if (tve_fbi != fbi)

947 break;

948

949 fbi->mode = (struct fb_videomode *)fb_match_mode(&tve_fbi->var,

950 &tve_modelist.list);

951

952 if (!fbi->mode) {

953 pr_warning("TVE: can not find mode for xres=%d, yres=%d\n",

954 fbi->var.xres, fbi->var.yres);

955 tve_disable();

956 tve.cur_mode = TVOUT_FMT_OFF;

957 return 0;

958 }

959

960 pr_debug("TVE: fb mode change event: xres=%d, yres=%d\n",

961 fbi->mode->xres, fbi->mode->yres);

962

963 if (fb_mode_is_equal(fbi->mode, &video_modes[0])) {

964 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

965 tve_disable();

966 tve_setup(TVOUT_FMT_NTSC);

967 if (tve.blank == FB_BLANK_UNBLANK)

968 tve_enable();

969 } else if (fb_mode_is_equal(fbi->mode, &video_modes[1])) {

970 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

971 tve_disable();

972 tve_setup(TVOUT_FMT_PAL);

973 if (tve.blank == FB_BLANK_UNBLANK)

974 tve_enable();

975 } else if (fb_mode_is_equal(fbi->mode, &video_modes[2])) {

976 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

977 tve_disable();

978 tve_setup(TVOUT_FMT_720P60);

979 if (tve.blank == FB_BLANK_UNBLANK)

980 tve_enable();

981 } else if (fb_mode_is_equal(fbi->mode, &video_modes[3])) {

982 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

983 tve_disable();

984 tve_setup(TVOUT_FMT_720P30);

985 if (tve.blank == FB_BLANK_UNBLANK)

986 tve_enable();

987 } else if (fb_mode_is_equal(fbi->mode, &video_modes[4])) {

988 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

989 tve_disable();

990 tve_setup(TVOUT_FMT_1080I60);

991 if (tve.blank == FB_BLANK_UNBLANK)

992 tve_enable();

993 } else if (fb_mode_is_equal(fbi->mode, &video_modes[5])) {

994 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

995 tve_disable();

996 tve_setup(TVOUT_FMT_1080I50);

997 if (tve.blank == FB_BLANK_UNBLANK)

998 tve_enable();

999 } else if (fb_mode_is_equal(fbi->mode, &video_modes[6])) {

1000 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

1001 tve_disable();

1002 tve_setup(TVOUT_FMT_1080P30);

1003 if (tve.blank == FB_BLANK_UNBLANK)

1004 tve_enable();

1005 } else if (fb_mode_is_equal(fbi->mode, &video_modes[7])) {

1006 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

1007 tve_disable();

1008 tve_setup(TVOUT_FMT_1080P25);

1009 if (tve.blank == FB_BLANK_UNBLANK)

1010 tve_enable();

1011 } else if (fb_mode_is_equal(fbi->mode, &video_modes[8])) {

1012 tve_set_di_fmt(fbi, IPU_PIX_FMT_YUV444);

1013 tve_disable();

1014 tve_setup(TVOUT_FMT_1080P24);

1015 if (tve.blank == FB_BLANK_UNBLANK)

1016 tve_enable();

1017 } else if (fb_mode_is_equal(fbi->mode, &video_modes[9])) {

1018 tve_set_di_fmt(fbi, IPU_PIX_FMT_GBR24);

1019 tve_disable();

1020 tve_setup(TVOUT_FMT_VGA_XGA);

1021 if (tve.blank == FB_BLANK_UNBLANK) {

1022 tve_enable();

1023 ipu_set_vga_delay(fbi, 1421, 803);

1024 }

1025 } else if (fb_mode_is_equal(fbi->mode, &video_modes[10])) {

1026 tve_set_di_fmt(fbi, IPU_PIX_FMT_GBR24);

1027 tve_disable();

1028 tve_setup(TVOUT_FMT_VGA_SXGA);

1029 if (tve.blank == FB_BLANK_UNBLANK) {

1030 tve_enable();

1031 ipu_set_vga_delay(fbi, 1504, 1030);

1032 }

1033 } else {

1034 tve_disable();

1035 tve_setup(TVOUT_FMT_OFF);

1036 }

1037 break;

1038 }

1039 case FB_EVENT_BLANK:

1040 if ((tve_fbi != fbi) || (fbi->mode == NULL))

1041 return 0;

1042

1043 if (*((int *)event->data) == FB_BLANK_UNBLANK) {

1044 if (tve.blank != FB_BLANK_UNBLANK) {

1045 if (fb_mode_is_equal(fbi->mode, &video_modes[0])) {

1046 if (tve.cur_mode != TVOUT_FMT_NTSC) {

1047 tve_disable();

1048 tve_setup(TVOUT_FMT_NTSC);

1049 }

1050 tve_enable();

1051 } else if (fb_mode_is_equal(fbi->mode,

1052 &video_modes[1])) {

1053 if (tve.cur_mode != TVOUT_FMT_PAL) {

1054 tve_disable();

1055 tve_setup(TVOUT_FMT_PAL);

1056 }

1057 tve_enable();

1058 } else if (fb_mode_is_equal(fbi->mode,

1059 &video_modes[2])) {

1060 if (tve.cur_mode != TVOUT_FMT_720P60) {

1061 tve_disable();

1062 tve_setup(TVOUT_FMT_720P60);

1063 }

1064 tve_enable();

1065 } else if (fb_mode_is_equal(fbi->mode,

1066 &video_modes[3])) {

1067 if (tve.cur_mode != TVOUT_FMT_720P30) {

1068 tve_disable();

1069 tve_setup(TVOUT_FMT_720P30);

1070 }

1071 tve_enable();

1072 } else if (fb_mode_is_equal(fbi->mode,

1073 &video_modes[4])) {

1074 if (tve.cur_mode != TVOUT_FMT_1080I60) {

1075 tve_disable();

1076 tve_setup(TVOUT_FMT_1080I60);

1077 }

1078 tve_enable();

1079 } else if (fb_mode_is_equal(fbi->mode,

1080 &video_modes[5])) {

1081 if (tve.cur_mode != TVOUT_FMT_1080I50) {

1082 tve_disable();

1083 tve_setup(TVOUT_FMT_1080I50);

1084 }

1085 tve_enable();

1086 } else if (fb_mode_is_equal(fbi->mode,

1087 &video_modes[6])) {

1088 if (tve.cur_mode != TVOUT_FMT_1080P30) {

1089 tve_disable();

1090 tve_setup(TVOUT_FMT_1080P30);

1091 }

1092 tve_enable();

1093 } else if (fb_mode_is_equal(fbi->mode,

1094 &video_modes[7])) {

1095 if (tve.cur_mode != TVOUT_FMT_1080P25) {

1096 tve_disable();

1097 tve_setup(TVOUT_FMT_1080P25);

1098 }

1099 tve_enable();

1100 } else if (fb_mode_is_equal(fbi->mode,

1101 &video_modes[8])) {

1102 if (tve.cur_mode != TVOUT_FMT_1080P24) {

1103 tve_disable();

1104 tve_setup(TVOUT_FMT_1080P24);

1105 }

1106 tve_enable();

1107 } else if (fb_mode_is_equal(fbi->mode,

1108 &video_modes[9])) {

1109 if (tve.cur_mode != TVOUT_FMT_VGA_XGA) {

1110 tve_disable();

1111 tve_setup(TVOUT_FMT_VGA_XGA);

1112 }

1113 tve_enable();

1114 ipu_set_vga_delay(fbi, 1421, 803);

1115 } else if (fb_mode_is_equal(fbi->mode,

1116 &video_modes[10])) {

1117 if (tve.cur_mode != TVOUT_FMT_VGA_SXGA) {

1118 tve_disable();

1119 tve_setup(TVOUT_FMT_VGA_SXGA);

1120 }

1121 tve_enable();

1122 ipu_set_vga_delay(fbi, 1504, 1030);

1123 } else {

1124 tve_setup(TVOUT_FMT_OFF);

1125 }

1126 tve.blank = FB_BLANK_UNBLANK;

1127 }

1128 } else {

1129 tve_disable();

1130 tve.blank = FB_BLANK_POWERDOWN;

1131 }

1132 break;

1133 case FB_EVENT_SUSPEND:

1134 tve_suspend();

1135 break;

1136 case FB_EVENT_RESUME:

1137 tve_resume(fbi);

1138 break;

1139 }

1140 return 0;

1141 }

918 ~ 919 因为tve_fb_event被调用时不知道是不是tve的事件，如果不是，不做处理

922 ~ 943 FB_EVENT_FB_REGISTERED，那么要把NTSC PAL 720P加入到mode_list中，如果是rev2再加入一些mode，如果是mx53还支持XGA SXGA模式

944 ~ 1038 处理模式发生变化的情况

949 ~ 958 先检查新mode是否在tve_modelist中，不在的话则tve_disable

963 ~ 1032 1. 调用tve_set_di_fmt设置display input format; 2. disable tve; 3. tve_setup设置TVE 输出模式; 4.如果tve_fbi是UNBLANK的，那么还要调用tve_enable使能TVE

1033 ~ 1036 disable TVE，设置TVE

1039 case FB_EVENT_BLANK:

1040 if ((tve_fbi != fbi) || (fbi->mode == NULL))

1041 return 0;

1042

1043 if (*((int *)event->data) == FB_BLANK_UNBLANK) {

1044 if (tve.blank != FB_BLANK_UNBLANK) {

1045 if (fb_mode_is_equal(fbi->mode, &video_modes[0])) {

1046 if (tve.cur_mode != TVOUT_FMT_NTSC) {

1047 tve_disable();

1048 tve_setup(TVOUT_FMT_NTSC);

1049 }

1050 tve_enable();

1051 } else if (fb_mode_is_equal(fbi->mode,

1052 &video_modes[1])) {

1053 if (tve.cur_mode != TVOUT_FMT_PAL) {

1054 tve_disable();

1055 tve_setup(TVOUT_FMT_PAL);

1056 }

1057 tve_enable();

1058 } else if (fb_mode_is_equal(fbi->mode,

1059 &video_modes[2])) {

1060 if (tve.cur_mode != TVOUT_FMT_720P60) {

1061 tve_disable();

1062 tve_setup(TVOUT_FMT_720P60);

1063 }

1064 tve_enable();

1065 } else if (fb_mode_is_equal(fbi->mode,

1066 &video_modes[3])) {

1067 if (tve.cur_mode != TVOUT_FMT_720P30) {

1068 tve_disable();

1069 tve_setup(TVOUT_FMT_720P30);

1070 }

1071 tve_enable();

1072 } else if (fb_mode_is_equal(fbi->mode,

1073 &video_modes[4])) {

1074 if (tve.cur_mode != TVOUT_FMT_1080I60) {

1075 tve_disable();

1076 tve_setup(TVOUT_FMT_1080I60);

1077 }

1078 tve_enable();

1079 } else if (fb_mode_is_equal(fbi->mode,

1080 &video_modes[5])) {

1081 if (tve.cur_mode != TVOUT_FMT_1080I50) {

1082 tve_disable();

1083 tve_setup(TVOUT_FMT_1080I50);

1084 }

1085 tve_enable();

1086 } else if (fb_mode_is_equal(fbi->mode,

1087 &video_modes[6])) {

1088 if (tve.cur_mode != TVOUT_FMT_1080P30) {

1089 tve_disable();

1090 tve_setup(TVOUT_FMT_1080P30);

1091 }

1092 tve_enable();

1093 } else if (fb_mode_is_equal(fbi->mode,

1094 &video_modes[7])) {

1095 if (tve.cur_mode != TVOUT_FMT_1080P25) {

1096 tve_disable();

1097 tve_setup(TVOUT_FMT_1080P25);

1098 }

1099 tve_enable();

1100 } else if (fb_mode_is_equal(fbi->mode,

1101 &video_modes[8])) {

1102 if (tve.cur_mode != TVOUT_FMT_1080P24) {

1103 tve_disable();

1104 tve_setup(TVOUT_FMT_1080P24);

1105 }

1106 tve_enable();

1107 } else if (fb_mode_is_equal(fbi->mode,

1108 &video_modes[9])) {

1109 if (tve.cur_mode != TVOUT_FMT_VGA_XGA) {

1110 tve_disable();

1111 tve_setup(TVOUT_FMT_VGA_XGA);

1112 }

1113 tve_enable();

1114 ipu_set_vga_delay(fbi, 1421, 803);

1115 } else if (fb_mode_is_equal(fbi->mode,

1116 &video_modes[10])) {

1117 if (tve.cur_mode != TVOUT_FMT_VGA_SXGA) {

1118 tve_disable();

1119 tve_setup(TVOUT_FMT_VGA_SXGA);

1120 }

1121 tve_enable();

1122 ipu_set_vga_delay(fbi, 1504, 1030);

1123 } else {

1124 tve_setup(TVOUT_FMT_OFF);

1125 }

1126 tve.blank = FB_BLANK_UNBLANK;

1127 }

1128 } else {

1129 tve_disable();

1130 tve.blank = FB_BLANK_POWERDOWN;

1131 }

1132 break;

1133 case FB_EVENT_SUSPEND:

1134 tve_suspend();

1135 break;

1136 case FB_EVENT_RESUME:

1137 tve_resume(fbi);

1138 break;

1139 }

1140 return 0;

1141 }

1128 ~ 1131 unblank操作，dsiable tve设置tve.blank为FB_BLANK_POWERDOWN

1043 ~ 1127 FB_BLANK_UNBLANK并且TVE当前状态不是FB_BLANK_UNBLANK，如果当前mode不是ffbi的当前模式，那么设置为当前模式，最后还要使能TVE

821 static inline void tve_set_di_fmt(struct fb_info *fbi, unsigned int fmt)

822 {

823 mm_segment_t old_fs;

824

825 if (fbi->fbops->fb_ioctl) {

826 old_fs = get_fs();

827 set_fs(KERNEL_DS);

828 fbi->fbops->fb_ioctl(fbi, MXCFB_SET_DIFMT, (unsigned long)&fmt);

829 set_fs(old_fs);

830 }

831 }

该函数调用fbi->fbops->fb_ioctl设置 display format，由于fmt是内核空间，而fb_ioctl系统调用会确定&fmt是用户空间，

所以需要把当前的fs设置为内核空间，避开这个检查。参见http://blog.chinaunix.net/space.php?uid=20564848&do=blog&cuid=2097853

771 static irqreturn_t tve_detect_handler(int irq, void *data)
772 {
773     u32 int_ctl = __raw_readl(tve.base + tve_regs->tve_int_cont_reg);
774
775     /* disable INT first */
776     int_ctl &= ~(CD_SM_INT | CD_LM_INT | CD_MON_END_INT);
777     __raw_writel(int_ctl, tve.base + tve_regs->tve_int_cont_reg);
778
779     __raw_writel(CD_MON_END_INT | CD_LM_INT | CD_SM_INT,
780             tve.base + tve_regs->tve_stat_reg);
781
782     schedule_delayed_work(&tve.cd_work, msecs_to_jiffies(1000));
783
784     return IRQ_HANDLED;
785 }

中断处理函数，首先disable INT清除中断状态位，然后清除掉tve_stat_reg中相应的状态位，这里我奇怪为什么要清除CD_MON_END_INT，因为tve_update_detect_status要使用这个标志呀

615 static void tve_disable(void)
616 {
617     u32 reg;
618     unsigned long lock_flags;
619
620     spin_lock_irqsave(&tve_lock, lock_flags);
621     if (enabled) {
622         enabled = 0;
623         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
624         __raw_writel(reg & ~TVE_ENABLE & ~TVE_IPU_CLK_ENABLE,
625                 tve.base + tve_regs->tve_com_conf_reg);
626         clk_disable(tve.clk);
627         pr_debug("TVE power off.\n");
628     }
629     spin_unlock_irqrestore(&tve_lock, lock_flags);
630 }
关闭TVE和TVE IPU clock，关闭tve.clk时钟，置位enable为0

578 static void tve_enable(void)
579 {
580     u32 reg;
581     unsigned long lock_flags;
582
583     spin_lock_irqsave(&tve_lock, lock_flags);
584     if (!enabled) {
585         enabled = 1;
586         clk_enable(tve.clk);
587         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
588         __raw_writel(reg | TVE_IPU_CLK_ENABLE | TVE_ENABLE,
589                     tve.base + tve_regs->tve_com_conf_reg);
590         pr_debug("TVE power on.\n");
591     }
592
593     if (is_vga_mode()) {
594         /* disable interrupt */
595         pr_debug("TVE VGA disable cable detect.\n");
596         __raw_writel(0xffffffff, tve.base + tve_regs->tve_stat_reg);
597         __raw_writel(0, tve.base + tve_regs->tve_int_cont_reg);
598     } else {
599         /* enable interrupt */
600         pr_debug("TVE TVE enable cable detect.\n");
601         __raw_writel(0xffffffff, tve.base + tve_regs->tve_stat_reg);
602         __raw_writel(CD_SM_INT | CD_LM_INT | CD_MON_END_INT,
603                 tve.base + tve_regs->tve_int_cont_reg);
604     }
605
606     spin_unlock_irqrestore(&tve_lock, lock_flags);
607
608     tve_dump_regs();
609 }

584 ～ 591 使能tve.clk，使能TVE以及TVE IPU clock

593 ~ 598 对于TVE VGA模式关闭cable detect

598 ~ 604 对于其他的模式使能cable detect

415 static int tve_setup(int mode)
416 {
417     u32 reg;
418     struct clk *tve_parent_clk;
419     unsigned long parent_clock_rate = 216000000, di1_clock_rate = 27000000;
420     unsigned long tve_clock_rate = 216000000;
421     unsigned long lock_flags;
422
423     if (tve.cur_mode == mode)
424         return 0;
425
426     spin_lock_irqsave(&tve_lock, lock_flags);
427
428     switch (mode) {
429     case TVOUT_FMT_PAL:
430     case TVOUT_FMT_NTSC:
431         parent_clock_rate = 216000000;
432         di1_clock_rate = 27000000;
433         break;
434     case TVOUT_FMT_720P60:
435     case TVOUT_FMT_1080I60:
436     case TVOUT_FMT_1080I50:
437     case TVOUT_FMT_720P30:
438     case TVOUT_FMT_1080P30:
439     case TVOUT_FMT_1080P25:
440     case TVOUT_FMT_1080P24:
441         parent_clock_rate = 297000000;
442         tve_clock_rate = 297000000;
443         di1_clock_rate = 74250000;
444         break;
445     case TVOUT_FMT_VGA_XGA:
446         parent_clock_rate = 260000000;
447         tve_clock_rate = 130000000;
448         di1_clock_rate = 65000000;
449         break;
450     case TVOUT_FMT_VGA_SXGA:
451         parent_clock_rate = 216000000;
452         di1_clock_rate = 108000000;
453         break;
454     }
455     if (enabled)
456         clk_disable(tve.clk);
457
458     tve_parent_clk = clk_get_parent(tve.clk);
459
460     clk_set_rate(tve_parent_clk, parent_clock_rate);
461
462     tve_clock_rate = clk_round_rate(tve.clk, tve_clock_rate);
463     clk_set_rate(tve.clk, tve_clock_rate);
464
465     clk_enable(tve.clk);
466     di1_clock_rate = clk_round_rate(tve.di_clk, di1_clock_rate);
467     clk_set_rate(tve.di_clk, di1_clock_rate);
468
469     tve.cur_mode = mode;
470
471     /* select output video format */
472     if (mode == TVOUT_FMT_PAL) {
473         tve_disable_vga_mode();
474         tve_set_tvout_mode(YPBPR);
475         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
476         reg = (reg & ~TVE_STAND_MASK) | TVE_PAL_STAND;
477         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
478         pr_debug("TVE: change to PAL video\n");
479     } else if (mode == TVOUT_FMT_NTSC) {
480         tve_disable_vga_mode();
481         tve_set_tvout_mode(YPBPR);
482         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
483         reg = (reg & ~TVE_STAND_MASK) | TVE_NTSC_STAND;
484         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
485         pr_debug("TVE: change to NTSC video\n");
486     } else if (mode == TVOUT_FMT_720P60) {
487         tve_disable_vga_mode();
488         if (!_is_tvout_mode_hd_compatible()) {
489             tve_set_tvout_mode(YPBPR);
490             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
491         }
492         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
493         reg = (reg & ~TVE_STAND_MASK) | TVE_HD720P60_STAND;
494         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
495         pr_debug("TVE: change to 720P60 video\n");
496     } else if (mode == TVOUT_FMT_720P30) {
497         tve_disable_vga_mode();
498         if (!_is_tvout_mode_hd_compatible()) {
499             tve_set_tvout_mode(YPBPR);
500             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
501         }
502         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
503         reg = (reg & ~TVE_STAND_MASK) | TVE_HD720P30_STAND;
504         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
505         pr_debug("TVE: change to 720P30 video\n");
506     } else if (mode == TVOUT_FMT_1080I60) {
507         tve_disable_vga_mode();
508         if (!_is_tvout_mode_hd_compatible()) {
509             tve_set_tvout_mode(YPBPR);
510             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
511         }
512         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
513         reg = (reg & ~TVE_STAND_MASK) | TVE_HD1080I60_STAND;
514         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
515         pr_debug("TVE: change to 1080I60 video\n");
516     } else if (mode == TVOUT_FMT_1080I50) {
517         tve_disable_vga_mode();
518         if (!_is_tvout_mode_hd_compatible()) {
519             tve_set_tvout_mode(YPBPR);
520             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
521         }
522         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
523         reg = (reg & ~TVE_STAND_MASK) | TVE_HD1080I50_STAND;
524         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
525         pr_debug("TVE: change to 1080I50 video\n");
526     } else if (mode == TVOUT_FMT_1080P30) {
527         tve_disable_vga_mode();
528         if (!_is_tvout_mode_hd_compatible()) {
529             tve_set_tvout_mode(YPBPR);
530             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
531         }
532         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
533         reg = (reg & ~TVE_STAND_MASK) | TVE_HD1080P30_STAND;
534         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
535         pr_debug("TVE: change to 1080P30 video\n");
536     } else if (mode == TVOUT_FMT_1080P25) {
537         tve_disable_vga_mode();
538         if (!_is_tvout_mode_hd_compatible()) {
539             tve_set_tvout_mode(YPBPR);
540             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
541         }
542         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
543         reg = (reg & ~TVE_STAND_MASK) | TVE_HD1080P25_STAND;
544         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
545         pr_debug("TVE: change to 1080P25 video\n");
546     } else if (mode == TVOUT_FMT_1080P24) {
547         tve_disable_vga_mode();
548         if (!_is_tvout_mode_hd_compatible()) {
549             tve_set_tvout_mode(YPBPR);
550             pr_debug("The TV out mode is HD incompatible. Setting to YPBPR.");
551         }
552         reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
553         reg = (reg & ~TVE_STAND_MASK) | TVE_HD1080P24_STAND;
554         __raw_writel(reg, tve.base + tve_regs->tve_com_conf_reg);
555         pr_debug("TVE: change to 1080P24 video\n");
556     } else if ((mode == TVOUT_FMT_VGA_XGA) || (mode == TVOUT_FMT_VGA_SXGA)) {
557         /* do not need cable detect */
558         tve_setup_vga();
559         pr_debug("TVE: change to VGA video\n");
560     } else if (mode == TVOUT_FMT_OFF) {
561         __raw_writel(0x0, tve.base + tve_regs->tve_com_conf_reg);
562         pr_debug("TVE: change to OFF video\n");
563     } else {
564         pr_debug("TVE: no such video format.\n");
565     }
566
567     if (!enabled)
568         clk_disable(tve.clk);
569
570     spin_unlock_irqrestore(&tve_lock, lock_flags);
571     return 0;
572 }

428 ～ 454根据输出模式，设置时钟屏率，这里没搞明白这几个时钟的关系，以后再分析
455和465 先关闭再使能，为了保证所有情况下都打开tve.clk，以便下面对tve的操作。

458 ～ 467 设置parent clock, tve clk以及di1 clock的时钟频率

472 ～565 根据mode设置TVE的输出格式，这里没看明白的就是474行，传入的 mode为什么是YPBPR? 不是应该传入CVBS0吗，看不懂，觉得这里有问题，或者这里需要根据情况hard code；然后把输出模式设置到tve_com_conf_reg中

567 ～ 568 已经用完tve.clk，关闭它

333 static void tve_set_tvout_mode(int mode)
334 {
335     u32 conf_reg;
336
337     /* clear sync_ch and tvout_mode fields */
338     conf_reg = __raw_readl(tve.base + tve_regs->tve_com_conf_reg);
339     conf_reg &= ~(tve_reg_fields->sync_ch_mask |
340                 tve_reg_fields->tvout_mode_mask);
341
342     conf_reg = conf_reg & ~TVE_DAC_SAMPRATE_MASK;
343     if (tve.revision == 2) {
344         conf_reg = (conf_reg & ~TVEV2_DATA_SRC_MASK) |
345             TVEV2_DATA_SRC_BUS_1;
346         conf_reg = conf_reg & ~TVEV2_INP_VIDEO_FORM;
347         conf_reg = conf_reg & ~TVEV2_P2I_CONV_EN;
348     }
349
350     conf_reg |=
351         mode << tve_reg_fields->
352         tvout_mode_offset | tvout_mode_to_channel_map[mode] <<
353         tve_reg_fields->sync_ch_offset;
354     __raw_writel(conf_reg, tve.base + tve_regs->tve_com_conf_reg);
355 }

344 ～ 345 设置TVEV2_DATA_SRC 为BUS_1，这里还是hard code，其实我觉得也可以设置为BUS_2，那么数据就从IPU data bus2过来

346 设置input video的格式为YCbCr422

347 禁止progressive 到interlace的转换，我觉得如果是要得到NTSC PAL输出，最好使能它

350 ~ 355 根据给定的模式设置TV_OUT_MODE, 以及SYNC_CH_X_EN

小结：

分析后，如果想要实现自己的LCD+cvbs双屏输入，还需要定制一些参数，也许没看懂，做freescale的东西，真累。

(kickxxx)

mx51 IPU 透明处理	Freescale ATK(Advanced ToolKit)工作原理及使用方法
ltib常用命令详解	LTIB 编译下载运行出错总结
freescale LTIB使用总结1	mx51 TVOUT cvbs双屏支持
MX51 uboot启动流程分析 - stage2	MX51 uboot 启动流程分析 - stage1
freescale R10 ipu lib 分析 - ipu_ic.c	EVC4不能调试Freescale MX31(ARM113)的解决方法

搜索

热门标签:

mx51 TVOUT分析