转：http://blog.youkuaiyun.com/kickxxx/article/details/6777980
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检测函数
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文件描述符的进程
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
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的东西，真累。
851
扫一扫
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
