]> git.karo-electronics.de Git - mv-sheeva.git/blobdiff - drivers/video/via/hw.c
viafb: make suspend and resume work (on all machines?)
[mv-sheeva.git] / drivers / video / via / hw.c
index b996803ae2c18b1c85efd5a1ba99b98c3293e9d6..7d7010acf1482576d69228e7ec7e2db42df666e8 100644 (file)
 #include "global.h"
 
 static struct pll_map pll_value[] = {
-       {CLK_25_175M, CLE266_PLL_25_175M, K800_PLL_25_175M,
-        CX700_25_175M, VX855_25_175M},
-       {CLK_29_581M, CLE266_PLL_29_581M, K800_PLL_29_581M,
-        CX700_29_581M, VX855_29_581M},
-       {CLK_26_880M, CLE266_PLL_26_880M, K800_PLL_26_880M,
-        CX700_26_880M, VX855_26_880M},
-       {CLK_31_490M, CLE266_PLL_31_490M, K800_PLL_31_490M,
-        CX700_31_490M, VX855_31_490M},
-       {CLK_31_500M, CLE266_PLL_31_500M, K800_PLL_31_500M,
-        CX700_31_500M, VX855_31_500M},
-       {CLK_31_728M, CLE266_PLL_31_728M, K800_PLL_31_728M,
-        CX700_31_728M, VX855_31_728M},
-       {CLK_32_668M, CLE266_PLL_32_668M, K800_PLL_32_668M,
-        CX700_32_668M, VX855_32_668M},
-       {CLK_36_000M, CLE266_PLL_36_000M, K800_PLL_36_000M,
-        CX700_36_000M, VX855_36_000M},
-       {CLK_40_000M, CLE266_PLL_40_000M, K800_PLL_40_000M,
-        CX700_40_000M, VX855_40_000M},
-       {CLK_41_291M, CLE266_PLL_41_291M, K800_PLL_41_291M,
-        CX700_41_291M, VX855_41_291M},
-       {CLK_43_163M, CLE266_PLL_43_163M, K800_PLL_43_163M,
-        CX700_43_163M, VX855_43_163M},
-       {CLK_45_250M, CLE266_PLL_45_250M, K800_PLL_45_250M,
-        CX700_45_250M, VX855_45_250M},
-       {CLK_46_000M, CLE266_PLL_46_000M, K800_PLL_46_000M,
-        CX700_46_000M, VX855_46_000M},
-       {CLK_46_996M, CLE266_PLL_46_996M, K800_PLL_46_996M,
-        CX700_46_996M, VX855_46_996M},
-       {CLK_48_000M, CLE266_PLL_48_000M, K800_PLL_48_000M,
-        CX700_48_000M, VX855_48_000M},
-       {CLK_48_875M, CLE266_PLL_48_875M, K800_PLL_48_875M,
-        CX700_48_875M, VX855_48_875M},
-       {CLK_49_500M, CLE266_PLL_49_500M, K800_PLL_49_500M,
-        CX700_49_500M, VX855_49_500M},
-       {CLK_52_406M, CLE266_PLL_52_406M, K800_PLL_52_406M,
-        CX700_52_406M, VX855_52_406M},
-       {CLK_52_977M, CLE266_PLL_52_977M, K800_PLL_52_977M,
-        CX700_52_977M, VX855_52_977M},
-       {CLK_56_250M, CLE266_PLL_56_250M, K800_PLL_56_250M,
-        CX700_56_250M, VX855_56_250M},
-       {CLK_57_275M, 0, 0, 0, VX855_57_275M},
-       {CLK_60_466M, CLE266_PLL_60_466M, K800_PLL_60_466M,
-        CX700_60_466M, VX855_60_466M},
-       {CLK_61_500M, CLE266_PLL_61_500M, K800_PLL_61_500M,
-        CX700_61_500M, VX855_61_500M},
-       {CLK_65_000M, CLE266_PLL_65_000M, K800_PLL_65_000M,
-        CX700_65_000M, VX855_65_000M},
-       {CLK_65_178M, CLE266_PLL_65_178M, K800_PLL_65_178M,
-        CX700_65_178M, VX855_65_178M},
-       {CLK_66_750M, CLE266_PLL_66_750M, K800_PLL_66_750M,
-        CX700_66_750M, VX855_66_750M},
-       {CLK_68_179M, CLE266_PLL_68_179M, K800_PLL_68_179M,
-        CX700_68_179M, VX855_68_179M},
-       {CLK_69_924M, CLE266_PLL_69_924M, K800_PLL_69_924M,
-        CX700_69_924M, VX855_69_924M},
-       {CLK_70_159M, CLE266_PLL_70_159M, K800_PLL_70_159M,
-        CX700_70_159M, VX855_70_159M},
-       {CLK_72_000M, CLE266_PLL_72_000M, K800_PLL_72_000M,
-        CX700_72_000M, VX855_72_000M},
-       {CLK_78_750M, CLE266_PLL_78_750M, K800_PLL_78_750M,
-        CX700_78_750M, VX855_78_750M},
-       {CLK_80_136M, CLE266_PLL_80_136M, K800_PLL_80_136M,
-        CX700_80_136M, VX855_80_136M},
-       {CLK_83_375M, CLE266_PLL_83_375M, K800_PLL_83_375M,
-        CX700_83_375M, VX855_83_375M},
-       {CLK_83_950M, CLE266_PLL_83_950M, K800_PLL_83_950M,
-        CX700_83_950M, VX855_83_950M},
-       {CLK_84_750M, CLE266_PLL_84_750M, K800_PLL_84_750M,
-        CX700_84_750M, VX855_84_750M},
-       {CLK_85_860M, CLE266_PLL_85_860M, K800_PLL_85_860M,
-        CX700_85_860M, VX855_85_860M},
-       {CLK_88_750M, CLE266_PLL_88_750M, K800_PLL_88_750M,
-        CX700_88_750M, VX855_88_750M},
-       {CLK_94_500M, CLE266_PLL_94_500M, K800_PLL_94_500M,
-        CX700_94_500M, VX855_94_500M},
-       {CLK_97_750M, CLE266_PLL_97_750M, K800_PLL_97_750M,
-        CX700_97_750M, VX855_97_750M},
-       {CLK_101_000M, CLE266_PLL_101_000M, K800_PLL_101_000M,
-        CX700_101_000M, VX855_101_000M},
-       {CLK_106_500M, CLE266_PLL_106_500M, K800_PLL_106_500M,
-        CX700_106_500M, VX855_106_500M},
-       {CLK_108_000M, CLE266_PLL_108_000M, K800_PLL_108_000M,
-        CX700_108_000M, VX855_108_000M},
-       {CLK_113_309M, CLE266_PLL_113_309M, K800_PLL_113_309M,
-        CX700_113_309M, VX855_113_309M},
-       {CLK_118_840M, CLE266_PLL_118_840M, K800_PLL_118_840M,
-        CX700_118_840M, VX855_118_840M},
-       {CLK_119_000M, CLE266_PLL_119_000M, K800_PLL_119_000M,
-        CX700_119_000M, VX855_119_000M},
-       {CLK_121_750M, CLE266_PLL_121_750M, K800_PLL_121_750M,
-        CX700_121_750M, 0},
-       {CLK_125_104M, CLE266_PLL_125_104M, K800_PLL_125_104M,
-        CX700_125_104M, 0},
-       {CLK_133_308M, CLE266_PLL_133_308M, K800_PLL_133_308M,
-        CX700_133_308M, 0},
-       {CLK_135_000M, CLE266_PLL_135_000M, K800_PLL_135_000M,
-        CX700_135_000M, VX855_135_000M},
-       {CLK_136_700M, CLE266_PLL_136_700M, K800_PLL_136_700M,
-        CX700_136_700M, VX855_136_700M},
-       {CLK_138_400M, CLE266_PLL_138_400M, K800_PLL_138_400M,
-        CX700_138_400M, VX855_138_400M},
-       {CLK_146_760M, CLE266_PLL_146_760M, K800_PLL_146_760M,
-        CX700_146_760M, VX855_146_760M},
-       {CLK_153_920M, CLE266_PLL_153_920M, K800_PLL_153_920M,
-        CX700_153_920M, VX855_153_920M},
-       {CLK_156_000M, CLE266_PLL_156_000M, K800_PLL_156_000M,
-        CX700_156_000M, VX855_156_000M},
-       {CLK_157_500M, CLE266_PLL_157_500M, K800_PLL_157_500M,
-        CX700_157_500M, VX855_157_500M},
-       {CLK_162_000M, CLE266_PLL_162_000M, K800_PLL_162_000M,
-        CX700_162_000M, VX855_162_000M},
-       {CLK_187_000M, CLE266_PLL_187_000M, K800_PLL_187_000M,
-        CX700_187_000M, VX855_187_000M},
-       {CLK_193_295M, CLE266_PLL_193_295M, K800_PLL_193_295M,
-        CX700_193_295M, VX855_193_295M},
-       {CLK_202_500M, CLE266_PLL_202_500M, K800_PLL_202_500M,
-        CX700_202_500M, VX855_202_500M},
-       {CLK_204_000M, CLE266_PLL_204_000M, K800_PLL_204_000M,
-        CX700_204_000M, VX855_204_000M},
-       {CLK_218_500M, CLE266_PLL_218_500M, K800_PLL_218_500M,
-        CX700_218_500M, VX855_218_500M},
-       {CLK_234_000M, CLE266_PLL_234_000M, K800_PLL_234_000M,
-        CX700_234_000M, VX855_234_000M},
-       {CLK_267_250M, CLE266_PLL_267_250M, K800_PLL_267_250M,
-        CX700_267_250M, VX855_267_250M},
-       {CLK_297_500M, CLE266_PLL_297_500M, K800_PLL_297_500M,
-        CX700_297_500M, VX855_297_500M},
-       {CLK_74_481M, CLE266_PLL_74_481M, K800_PLL_74_481M,
-        CX700_74_481M, VX855_74_481M},
-       {CLK_172_798M, CLE266_PLL_172_798M, K800_PLL_172_798M,
-        CX700_172_798M, VX855_172_798M},
-       {CLK_122_614M, CLE266_PLL_122_614M, K800_PLL_122_614M,
-        CX700_122_614M, VX855_122_614M},
-       {CLK_74_270M, CLE266_PLL_74_270M, K800_PLL_74_270M,
-        CX700_74_270M, 0},
-       {CLK_148_500M, CLE266_PLL_148_500M, K800_PLL_148_500M,
-        CX700_148_500M, VX855_148_500M}
+       {25175000,
+               {99, 7, 3},
+               {85, 3, 4},     /* ignoring bit difference: 0x00008000 */
+               {141, 5, 4},
+               {141, 5, 4} },
+       {29581000,
+               {33, 4, 2},
+               {66, 2, 4},     /* ignoring bit difference: 0x00808000 */
+               {166, 5, 4},    /* ignoring bit difference: 0x00008000 */
+               {165, 5, 4} },
+       {26880000,
+               {15, 4, 1},
+               {30, 2, 3},     /* ignoring bit difference: 0x00808000 */
+               {150, 5, 4},
+               {150, 5, 4} },
+       {31500000,
+               {53, 3, 3},     /* ignoring bit difference: 0x00008000 */
+               {141, 4, 4},    /* ignoring bit difference: 0x00008000 */
+               {176, 5, 4},
+               {176, 5, 4} },
+       {31728000,
+               {31, 7, 1},
+               {177, 5, 4},    /* ignoring bit difference: 0x00008000 */
+               {177, 5, 4},
+               {142, 4, 4} },
+       {32688000,
+               {73, 4, 3},
+               {146, 4, 4},    /* ignoring bit difference: 0x00008000 */
+               {183, 5, 4},
+               {146, 4, 4} },
+       {36000000,
+               {101, 5, 3},    /* ignoring bit difference: 0x00008000 */
+               {161, 4, 4},    /* ignoring bit difference: 0x00008000 */
+               {202, 5, 4},
+               {161, 4, 4} },
+       {40000000,
+               {89, 4, 3},
+               {89, 4, 3},     /* ignoring bit difference: 0x00008000 */
+               {112, 5, 3},
+               {112, 5, 3} },
+       {41291000,
+               {23, 4, 1},
+               {69, 3, 3},     /* ignoring bit difference: 0x00008000 */
+               {115, 5, 3},
+               {115, 5, 3} },
+       {43163000,
+               {121, 5, 3},
+               {121, 5, 3},    /* ignoring bit difference: 0x00008000 */
+               {121, 5, 3},
+               {121, 5, 3} },
+       {45250000,
+               {127, 5, 3},
+               {127, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {127, 5, 3},
+               {127, 5, 3} },
+       {46000000,
+               {90, 7, 2},
+               {103, 4, 3},    /* ignoring bit difference: 0x00008000 */
+               {129, 5, 3},
+               {103, 4, 3} },
+       {46996000,
+               {105, 4, 3},    /* ignoring bit difference: 0x00008000 */
+               {131, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {131, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {105, 4, 3} },
+       {48000000,
+               {67, 20, 0},
+               {134, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {134, 5, 3},
+               {134, 5, 3} },
+       {48875000,
+               {99, 29, 0},
+               {82, 3, 3},     /* ignoring bit difference: 0x00808000 */
+               {82, 3, 3},     /* ignoring bit difference: 0x00808000 */
+               {137, 5, 3} },
+       {49500000,
+               {83, 6, 2},
+               {83, 3, 3},     /* ignoring bit difference: 0x00008000 */
+               {138, 5, 3},
+               {83, 3, 3} },
+       {52406000,
+               {117, 4, 3},
+               {117, 4, 3},    /* ignoring bit difference: 0x00008000 */
+               {117, 4, 3},
+               {88, 3, 3} },
+       {52977000,
+               {37, 5, 1},
+               {148, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {148, 5, 3},
+               {148, 5, 3} },
+       {56250000,
+               {55, 7, 1},     /* ignoring bit difference: 0x00008000 */
+               {126, 4, 3},    /* ignoring bit difference: 0x00008000 */
+               {157, 5, 3},
+               {157, 5, 3} },
+       {57275000,
+               {0, 0, 0},
+               {2, 2, 0},
+               {2, 2, 0},
+               {157, 5, 3} },  /* ignoring bit difference: 0x00808000 */
+       {60466000,
+               {76, 9, 1},
+               {169, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {169, 5, 3},    /* FIXED: old = {72, 2, 3} */
+               {169, 5, 3} },
+       {61500000,
+               {86, 20, 0},
+               {172, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {172, 5, 3},
+               {172, 5, 3} },
+       {65000000,
+               {109, 6, 2},    /* ignoring bit difference: 0x00008000 */
+               {109, 3, 3},    /* ignoring bit difference: 0x00008000 */
+               {109, 3, 3},
+               {109, 3, 3} },
+       {65178000,
+               {91, 5, 2},
+               {182, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {109, 3, 3},
+               {182, 5, 3} },
+       {66750000,
+               {75, 4, 2},
+               {150, 4, 3},    /* ignoring bit difference: 0x00808000 */
+               {150, 4, 3},
+               {112, 3, 3} },
+       {68179000,
+               {19, 4, 0},
+               {114, 3, 3},    /* ignoring bit difference: 0x00008000 */
+               {190, 5, 3},
+               {191, 5, 3} },
+       {69924000,
+               {83, 17, 0},
+               {195, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {195, 5, 3},
+               {195, 5, 3} },
+       {70159000,
+               {98, 20, 0},
+               {196, 5, 3},    /* ignoring bit difference: 0x00808000 */
+               {196, 5, 3},
+               {195, 5, 3} },
+       {72000000,
+               {121, 24, 0},
+               {161, 4, 3},    /* ignoring bit difference: 0x00808000 */
+               {161, 4, 3},
+               {161, 4, 3} },
+       {78750000,
+               {33, 3, 1},
+               {66, 3, 2},     /* ignoring bit difference: 0x00008000 */
+               {110, 5, 2},
+               {110, 5, 2} },
+       {80136000,
+               {28, 5, 0},
+               {68, 3, 2},     /* ignoring bit difference: 0x00008000 */
+               {112, 5, 2},
+               {112, 5, 2} },
+       {83375000,
+               {93, 2, 3},
+               {93, 4, 2},     /* ignoring bit difference: 0x00800000 */
+               {93, 4, 2},     /* ignoring bit difference: 0x00800000 */
+               {117, 5, 2} },
+       {83950000,
+               {41, 7, 0},
+               {117, 5, 2},    /* ignoring bit difference: 0x00008000 */
+               {117, 5, 2},
+               {117, 5, 2} },
+       {84750000,
+               {118, 5, 2},
+               {118, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {118, 5, 2},
+               {118, 5, 2} },
+       {85860000,
+               {84, 7, 1},
+               {120, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {120, 5, 2},
+               {118, 5, 2} },
+       {88750000,
+               {31, 5, 0},
+               {124, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {174, 7, 2},    /* ignoring bit difference: 0x00808000 */
+               {124, 5, 2} },
+       {94500000,
+               {33, 5, 0},
+               {132, 5, 2},    /* ignoring bit difference: 0x00008000 */
+               {132, 5, 2},
+               {132, 5, 2} },
+       {97750000,
+               {82, 6, 1},
+               {137, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {137, 5, 2},
+               {137, 5, 2} },
+       {101000000,
+               {127, 9, 1},
+               {141, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {141, 5, 2},
+               {141, 5, 2} },
+       {106500000,
+               {119, 4, 2},
+               {119, 4, 2},    /* ignoring bit difference: 0x00808000 */
+               {119, 4, 2},
+               {149, 5, 2} },
+       {108000000,
+               {121, 4, 2},
+               {121, 4, 2},    /* ignoring bit difference: 0x00808000 */
+               {151, 5, 2},
+               {151, 5, 2} },
+       {113309000,
+               {95, 12, 0},
+               {95, 3, 2},     /* ignoring bit difference: 0x00808000 */
+               {95, 3, 2},
+               {159, 5, 2} },
+       {118840000,
+               {83, 5, 1},
+               {166, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {166, 5, 2},
+               {166, 5, 2} },
+       {119000000,
+               {108, 13, 0},
+               {133, 4, 2},    /* ignoring bit difference: 0x00808000 */
+               {133, 4, 2},
+               {167, 5, 2} },
+       {121750000,
+               {85, 5, 1},
+               {170, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {68, 2, 2},
+               {0, 0, 0} },
+       {125104000,
+               {53, 6, 0},     /* ignoring bit difference: 0x00008000 */
+               {106, 3, 2},    /* ignoring bit difference: 0x00008000 */
+               {175, 5, 2},
+               {0, 0, 0} },
+       {135000000,
+               {94, 5, 1},
+               {28, 3, 0},     /* ignoring bit difference: 0x00804000 */
+               {151, 4, 2},
+               {189, 5, 2} },
+       {136700000,
+               {115, 12, 0},
+               {191, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {191, 5, 2},
+               {191, 5, 2} },
+       {138400000,
+               {87, 9, 0},
+               {116, 3, 2},    /* ignoring bit difference: 0x00808000 */
+               {116, 3, 2},
+               {194, 5, 2} },
+       {146760000,
+               {103, 5, 1},
+               {206, 5, 2},    /* ignoring bit difference: 0x00808000 */
+               {206, 5, 2},
+               {206, 5, 2} },
+       {153920000,
+               {86, 8, 0},
+               {86, 4, 1},     /* ignoring bit difference: 0x00808000 */
+               {86, 4, 1},
+               {86, 4, 1} },   /* FIXED: old = {84, 2, 1} */
+       {156000000,
+               {109, 5, 1},
+               {109, 5, 1},    /* ignoring bit difference: 0x00808000 */
+               {109, 5, 1},
+               {108, 5, 1} },
+       {157500000,
+               {55, 5, 0},     /* ignoring bit difference: 0x00008000 */
+               {22, 2, 0},     /* ignoring bit difference: 0x00802000 */
+               {110, 5, 1},
+               {110, 5, 1} },
+       {162000000,
+               {113, 5, 1},
+               {113, 5, 1},    /* ignoring bit difference: 0x00808000 */
+               {113, 5, 1},
+               {113, 5, 1} },
+       {187000000,
+               {118, 9, 0},
+               {131, 5, 1},    /* ignoring bit difference: 0x00808000 */
+               {131, 5, 1},
+               {131, 5, 1} },
+       {193295000,
+               {108, 8, 0},
+               {81, 3, 1},     /* ignoring bit difference: 0x00808000 */
+               {135, 5, 1},
+               {135, 5, 1} },
+       {202500000,
+               {99, 7, 0},
+               {85, 3, 1},     /* ignoring bit difference: 0x00808000 */
+               {142, 5, 1},
+               {142, 5, 1} },
+       {204000000,
+               {100, 7, 0},
+               {143, 5, 1},    /* ignoring bit difference: 0x00808000 */
+               {143, 5, 1},
+               {143, 5, 1} },
+       {218500000,
+               {92, 6, 0},
+               {153, 5, 1},    /* ignoring bit difference: 0x00808000 */
+               {153, 5, 1},
+               {153, 5, 1} },
+       {234000000,
+               {98, 6, 0},
+               {98, 3, 1},     /* ignoring bit difference: 0x00008000 */
+               {98, 3, 1},
+               {164, 5, 1} },
+       {267250000,
+               {112, 6, 0},
+               {112, 3, 1},    /* ignoring bit difference: 0x00808000 */
+               {187, 5, 1},
+               {187, 5, 1} },
+       {297500000,
+               {102, 5, 0},    /* ignoring bit difference: 0x00008000 */
+               {166, 4, 1},    /* ignoring bit difference: 0x00008000 */
+               {208, 5, 1},
+               {208, 5, 1} },
+       {74481000,
+               {26, 5, 0},
+               {125, 3, 3},    /* ignoring bit difference: 0x00808000 */
+               {208, 5, 3},
+               {209, 5, 3} },
+       {172798000,
+               {121, 5, 1},
+               {121, 5, 1},    /* ignoring bit difference: 0x00808000 */
+               {121, 5, 1},
+               {121, 5, 1} },
+       {122614000,
+               {60, 7, 0},
+               {137, 4, 2},    /* ignoring bit difference: 0x00808000 */
+               {137, 4, 2},
+               {172, 5, 2} },
+       {74270000,
+               {83, 8, 1},
+               {208, 5, 3},
+               {208, 5, 3},
+               {0, 0, 0} },
+       {148500000,
+               {83, 8, 0},
+               {208, 5, 2},
+               {166, 4, 2},
+               {208, 5, 2} }
 };
 
 static struct fifo_depth_select display_fifo_depth_reg = {
@@ -520,16 +718,20 @@ static struct rgbLUT palLUT_table[] = {
                                                                     0x00}
 };
 
-static void set_crt_output_path(int set_iga);
-static void dvi_patch_skew_dvp0(void);
-static void dvi_patch_skew_dvp1(void);
-static void dvi_patch_skew_dvp_low(void);
-static void set_dvi_output_path(int set_iga, int output_interface);
-static void set_lcd_output_path(int set_iga, int output_interface);
+static struct via_device_mapping device_mapping[] = {
+       {VIA_LDVP0, "LDVP0"},
+       {VIA_LDVP1, "LDVP1"},
+       {VIA_DVP0, "DVP0"},
+       {VIA_CRT, "CRT"},
+       {VIA_DVP1, "DVP1"},
+       {VIA_LVDS1, "LVDS1"},
+       {VIA_LVDS2, "LVDS2"}
+};
+
 static void load_fix_bit_crtc_reg(void);
-static void init_gfx_chip_info(int chip_type);
-static void init_tmds_chip_info(void);
-static void init_lvds_chip_info(void);
+static void __devinit init_gfx_chip_info(int chip_type);
+static void __devinit init_tmds_chip_info(void);
+static void __devinit init_lvds_chip_info(void);
 static void device_screen_off(void);
 static void device_screen_on(void);
 static void set_display_channel(void);
@@ -557,6 +759,66 @@ void write_dac_reg(u8 index, u8 r, u8 g, u8 b)
        outb(b, LUT_DATA);
 }
 
+static u32 get_dvi_devices(int output_interface)
+{
+       switch (output_interface) {
+       case INTERFACE_DVP0:
+               return VIA_DVP0 | VIA_LDVP0;
+
+       case INTERFACE_DVP1:
+               if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266)
+                       return VIA_LDVP1;
+               else
+                       return VIA_DVP1;
+
+       case INTERFACE_DFP_HIGH:
+               if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266)
+                       return 0;
+               else
+                       return VIA_LVDS2 | VIA_DVP0;
+
+       case INTERFACE_DFP_LOW:
+               if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266)
+                       return 0;
+               else
+                       return VIA_DVP1 | VIA_LVDS1;
+
+       case INTERFACE_TMDS:
+               return VIA_LVDS1;
+       }
+
+       return 0;
+}
+
+static u32 get_lcd_devices(int output_interface)
+{
+       switch (output_interface) {
+       case INTERFACE_DVP0:
+               return VIA_DVP0;
+
+       case INTERFACE_DVP1:
+               return VIA_DVP1;
+
+       case INTERFACE_DFP_HIGH:
+               return VIA_LVDS2 | VIA_DVP0;
+
+       case INTERFACE_DFP_LOW:
+               return VIA_LVDS1 | VIA_DVP1;
+
+       case INTERFACE_DFP:
+               return VIA_LVDS1 | VIA_LVDS2;
+
+       case INTERFACE_LVDS0:
+       case INTERFACE_LVDS0LVDS1:
+               return VIA_LVDS1;
+
+       case INTERFACE_LVDS1:
+               return VIA_LVDS2;
+       }
+
+       return 0;
+}
+
 /*Set IGA path for each device*/
 void viafb_set_iga_path(void)
 {
@@ -623,6 +885,48 @@ void viafb_set_iga_path(void)
                        viaparinfo->tmds_setting_info->iga_path = IGA1;
                }
        }
+
+       viaparinfo->shared->iga1_devices = 0;
+       viaparinfo->shared->iga2_devices = 0;
+       if (viafb_CRT_ON) {
+               if (viaparinfo->crt_setting_info->iga_path == IGA1)
+                       viaparinfo->shared->iga1_devices |= VIA_CRT;
+               else
+                       viaparinfo->shared->iga2_devices |= VIA_CRT;
+       }
+
+       if (viafb_DVI_ON) {
+               if (viaparinfo->tmds_setting_info->iga_path == IGA1)
+                       viaparinfo->shared->iga1_devices |= get_dvi_devices(
+                               viaparinfo->chip_info->
+                               tmds_chip_info.output_interface);
+               else
+                       viaparinfo->shared->iga2_devices |= get_dvi_devices(
+                               viaparinfo->chip_info->
+                               tmds_chip_info.output_interface);
+       }
+
+       if (viafb_LCD_ON) {
+               if (viaparinfo->lvds_setting_info->iga_path == IGA1)
+                       viaparinfo->shared->iga1_devices |= get_lcd_devices(
+                               viaparinfo->chip_info->
+                               lvds_chip_info.output_interface);
+               else
+                       viaparinfo->shared->iga2_devices |= get_lcd_devices(
+                               viaparinfo->chip_info->
+                               lvds_chip_info.output_interface);
+       }
+
+       if (viafb_LCD2_ON) {
+               if (viaparinfo->lvds_setting_info2->iga_path == IGA1)
+                       viaparinfo->shared->iga1_devices |= get_lcd_devices(
+                               viaparinfo->chip_info->
+                               lvds_chip_info2.output_interface);
+               else
+                       viaparinfo->shared->iga2_devices |= get_lcd_devices(
+                               viaparinfo->chip_info->
+                               lvds_chip_info2.output_interface);
+       }
 }
 
 static void set_color_register(u8 index, u8 red, u8 green, u8 blue)
@@ -646,295 +950,266 @@ void viafb_set_secondary_color_register(u8 index, u8 red, u8 green, u8 blue)
        set_color_register(index, red, green, blue);
 }
 
-void viafb_set_output_path(int device, int set_iga, int output_interface)
+static void set_source_common(u8 index, u8 offset, u8 iga)
 {
-       switch (device) {
-       case DEVICE_CRT:
-               set_crt_output_path(set_iga);
-               break;
-       case DEVICE_DVI:
-               set_dvi_output_path(set_iga, output_interface);
+       u8 value, mask = 1 << offset;
+
+       switch (iga) {
+       case IGA1:
+               value = 0x00;
                break;
-       case DEVICE_LCD:
-               set_lcd_output_path(set_iga, output_interface);
+       case IGA2:
+               value = mask;
                break;
+       default:
+               printk(KERN_WARNING "viafb: Unsupported source: %d\n", iga);
+               return;
        }
+
+       via_write_reg_mask(VIACR, index, value, mask);
 }
 
-static void set_crt_output_path(int set_iga)
+static void set_crt_source(u8 iga)
 {
-       viafb_write_reg_mask(CR36, VIACR, 0x00, BIT4 + BIT5);
+       u8 value;
 
-       switch (set_iga) {
+       switch (iga) {
        case IGA1:
-               viafb_write_reg_mask(SR16, VIASR, 0x00, BIT6);
+               value = 0x00;
                break;
        case IGA2:
-               viafb_write_reg_mask(CR6A, VIACR, 0xC0, BIT6 + BIT7);
-               viafb_write_reg_mask(SR16, VIASR, 0x40, BIT6);
+               value = 0x40;
                break;
+       default:
+               printk(KERN_WARNING "viafb: Unsupported source: %d\n", iga);
+               return;
        }
+
+       via_write_reg_mask(VIASR, 0x16, value, 0x40);
 }
 
-static void dvi_patch_skew_dvp0(void)
+static inline void set_ldvp0_source(u8 iga)
 {
-       /* Reset data driving first: */
-       viafb_write_reg_mask(SR1B, VIASR, 0, BIT1);
-       viafb_write_reg_mask(SR2A, VIASR, 0, BIT4);
-
-       switch (viaparinfo->chip_info->gfx_chip_name) {
-       case UNICHROME_P4M890:
-               {
-                       if ((viaparinfo->tmds_setting_info->h_active == 1600) &&
-                               (viaparinfo->tmds_setting_info->v_active ==
-                               1200))
-                               viafb_write_reg_mask(CR96, VIACR, 0x03,
-                                              BIT0 + BIT1 + BIT2);
-                       else
-                               viafb_write_reg_mask(CR96, VIACR, 0x07,
-                                              BIT0 + BIT1 + BIT2);
-                       break;
-               }
+       set_source_common(0x6C, 7, iga);
+}
 
-       case UNICHROME_P4M900:
-               {
-                       viafb_write_reg_mask(CR96, VIACR, 0x07,
-                                      BIT0 + BIT1 + BIT2 + BIT3);
-                       viafb_write_reg_mask(SR1B, VIASR, 0x02, BIT1);
-                       viafb_write_reg_mask(SR2A, VIASR, 0x10, BIT4);
-                       break;
-               }
+static inline void set_ldvp1_source(u8 iga)
+{
+       set_source_common(0x93, 7, iga);
+}
 
-       default:
-               {
-                       break;
-               }
-       }
+static inline void set_dvp0_source(u8 iga)
+{
+       set_source_common(0x96, 4, iga);
 }
 
-static void dvi_patch_skew_dvp1(void)
+static inline void set_dvp1_source(u8 iga)
 {
-       switch (viaparinfo->chip_info->gfx_chip_name) {
-       case UNICHROME_CX700:
-               {
-                       break;
-               }
+       set_source_common(0x9B, 4, iga);
+}
 
-       default:
-               {
-                       break;
-               }
-       }
+static inline void set_lvds1_source(u8 iga)
+{
+       set_source_common(0x99, 4, iga);
 }
 
-static void dvi_patch_skew_dvp_low(void)
+static inline void set_lvds2_source(u8 iga)
 {
-       switch (viaparinfo->chip_info->gfx_chip_name) {
-       case UNICHROME_K8M890:
-               {
-                       viafb_write_reg_mask(CR99, VIACR, 0x03, BIT0 + BIT1);
-                       break;
-               }
+       set_source_common(0x97, 4, iga);
+}
 
-       case UNICHROME_P4M900:
-               {
-                       viafb_write_reg_mask(CR99, VIACR, 0x08,
-                                      BIT0 + BIT1 + BIT2 + BIT3);
-                       break;
-               }
+void via_set_source(u32 devices, u8 iga)
+{
+       if (devices & VIA_LDVP0)
+               set_ldvp0_source(iga);
+       if (devices & VIA_LDVP1)
+               set_ldvp1_source(iga);
+       if (devices & VIA_DVP0)
+               set_dvp0_source(iga);
+       if (devices & VIA_CRT)
+               set_crt_source(iga);
+       if (devices & VIA_DVP1)
+               set_dvp1_source(iga);
+       if (devices & VIA_LVDS1)
+               set_lvds1_source(iga);
+       if (devices & VIA_LVDS2)
+               set_lvds2_source(iga);
+}
 
-       case UNICHROME_P4M890:
-               {
-                       viafb_write_reg_mask(CR99, VIACR, 0x0F,
-                                      BIT0 + BIT1 + BIT2 + BIT3);
-                       break;
-               }
+static void set_crt_state(u8 state)
+{
+       u8 value;
 
+       switch (state) {
+       case VIA_STATE_ON:
+               value = 0x00;
+               break;
+       case VIA_STATE_STANDBY:
+               value = 0x10;
+               break;
+       case VIA_STATE_SUSPEND:
+               value = 0x20;
+               break;
+       case VIA_STATE_OFF:
+               value = 0x30;
+               break;
        default:
-               {
-                       break;
-               }
+               return;
        }
+
+       via_write_reg_mask(VIACR, 0x36, value, 0x30);
 }
 
-static void set_dvi_output_path(int set_iga, int output_interface)
+static void set_dvp0_state(u8 state)
 {
-       switch (output_interface) {
-       case INTERFACE_DVP0:
-               viafb_write_reg_mask(CR6B, VIACR, 0x01, BIT0);
+       u8 value;
 
-               if (set_iga == IGA1) {
-                       viafb_write_reg_mask(CR96, VIACR, 0x00, BIT4);
-                       viafb_write_reg_mask(CR6C, VIACR, 0x21, BIT0 +
-                               BIT5 + BIT7);
-               } else {
-                       viafb_write_reg_mask(CR96, VIACR, 0x10, BIT4);
-                       viafb_write_reg_mask(CR6C, VIACR, 0xA1, BIT0 +
-                               BIT5 + BIT7);
-               }
-
-               viafb_write_reg_mask(SR1E, VIASR, 0xC0, BIT7 + BIT6);
-
-               dvi_patch_skew_dvp0();
+       switch (state) {
+       case VIA_STATE_ON:
+               value = 0xC0;
+               break;
+       case VIA_STATE_OFF:
+               value = 0x00;
                break;
+       default:
+               return;
+       }
 
-       case INTERFACE_DVP1:
-               if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266) {
-                       if (set_iga == IGA1)
-                               viafb_write_reg_mask(CR93, VIACR, 0x21,
-                                              BIT0 + BIT5 + BIT7);
-                       else
-                               viafb_write_reg_mask(CR93, VIACR, 0xA1,
-                                              BIT0 + BIT5 + BIT7);
-               } else {
-                       if (set_iga == IGA1)
-                               viafb_write_reg_mask(CR9B, VIACR, 0x00, BIT4);
-                       else
-                               viafb_write_reg_mask(CR9B, VIACR, 0x10, BIT4);
-               }
+       via_write_reg_mask(VIASR, 0x1E, value, 0xC0);
+}
+
+static void set_dvp1_state(u8 state)
+{
+       u8 value;
 
-               viafb_write_reg_mask(SR1E, VIASR, 0x30, BIT4 + BIT5);
-               dvi_patch_skew_dvp1();
+       switch (state) {
+       case VIA_STATE_ON:
+               value = 0x30;
                break;
-       case INTERFACE_DFP_HIGH:
-               if (viaparinfo->chip_info->gfx_chip_name != UNICHROME_CLE266) {
-                       if (set_iga == IGA1) {
-                               viafb_write_reg_mask(CR96, VIACR, 0x00, BIT4);
-                               viafb_write_reg_mask(CR97, VIACR, 0x03,
-                                              BIT0 + BIT1 + BIT4);
-                       } else {
-                               viafb_write_reg_mask(CR96, VIACR, 0x10, BIT4);
-                               viafb_write_reg_mask(CR97, VIACR, 0x13,
-                                              BIT0 + BIT1 + BIT4);
-                       }
-               }
-               viafb_write_reg_mask(SR2A, VIASR, 0x0C, BIT2 + BIT3);
+       case VIA_STATE_OFF:
+               value = 0x00;
                break;
+       default:
+               return;
+       }
 
-       case INTERFACE_DFP_LOW:
-               if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266)
-                       break;
+       via_write_reg_mask(VIASR, 0x1E, value, 0x30);
+}
 
-               if (set_iga == IGA1) {
-                       viafb_write_reg_mask(CR99, VIACR, 0x00, BIT4);
-                       viafb_write_reg_mask(CR9B, VIACR, 0x00, BIT4);
-               } else {
-                       viafb_write_reg_mask(CR99, VIACR, 0x10, BIT4);
-                       viafb_write_reg_mask(CR9B, VIACR, 0x10, BIT4);
-               }
+static void set_lvds1_state(u8 state)
+{
+       u8 value;
 
-               viafb_write_reg_mask(SR2A, VIASR, 0x03, BIT0 + BIT1);
-               dvi_patch_skew_dvp_low();
+       switch (state) {
+       case VIA_STATE_ON:
+               value = 0x03;
                break;
-
-       case INTERFACE_TMDS:
-               if (set_iga == IGA1)
-                       viafb_write_reg_mask(CR99, VIACR, 0x00, BIT4);
-               else
-                       viafb_write_reg_mask(CR99, VIACR, 0x10, BIT4);
+       case VIA_STATE_OFF:
+               value = 0x00;
                break;
+       default:
+               return;
        }
 
-       if (set_iga == IGA2) {
-               enable_second_display_channel();
-               /* Disable LCD Scaling */
-               viafb_write_reg_mask(CR79, VIACR, 0x00, BIT0);
-       }
+       via_write_reg_mask(VIASR, 0x2A, value, 0x03);
 }
 
-static void set_lcd_output_path(int set_iga, int output_interface)
+static void set_lvds2_state(u8 state)
 {
-       DEBUG_MSG(KERN_INFO
-                 "set_lcd_output_path, iga:%d,out_interface:%d\n",
-                 set_iga, output_interface);
-       switch (set_iga) {
-       case IGA1:
-               viafb_write_reg_mask(CR6B, VIACR, 0x00, BIT3);
-               viafb_write_reg_mask(CR6A, VIACR, 0x08, BIT3);
+       u8 value;
 
-               disable_second_display_channel();
+       switch (state) {
+       case VIA_STATE_ON:
+               value = 0x0C;
                break;
-
-       case IGA2:
-               viafb_write_reg_mask(CR6B, VIACR, 0x00, BIT3);
-               viafb_write_reg_mask(CR6A, VIACR, 0x08, BIT3);
-
-               enable_second_display_channel();
+       case VIA_STATE_OFF:
+               value = 0x00;
                break;
+       default:
+               return;
        }
 
-       switch (output_interface) {
-       case INTERFACE_DVP0:
-               if (set_iga == IGA1) {
-                       viafb_write_reg_mask(CR96, VIACR, 0x00, BIT4);
-               } else {
-                       viafb_write_reg(CR91, VIACR, 0x00);
-                       viafb_write_reg_mask(CR96, VIACR, 0x10, BIT4);
-               }
-               break;
-
-       case INTERFACE_DVP1:
-               if (set_iga == IGA1)
-                       viafb_write_reg_mask(CR9B, VIACR, 0x00, BIT4);
-               else {
-                       viafb_write_reg(CR91, VIACR, 0x00);
-                       viafb_write_reg_mask(CR9B, VIACR, 0x10, BIT4);
-               }
-               break;
+       via_write_reg_mask(VIASR, 0x2A, value, 0x0C);
+}
 
-       case INTERFACE_DFP_HIGH:
-               if (set_iga == IGA1)
-                       viafb_write_reg_mask(CR97, VIACR, 0x00, BIT4);
-               else {
-                       viafb_write_reg(CR91, VIACR, 0x00);
-                       viafb_write_reg_mask(CR97, VIACR, 0x10, BIT4);
-                       viafb_write_reg_mask(CR96, VIACR, 0x10, BIT4);
-               }
-               break;
+void via_set_state(u32 devices, u8 state)
+{
+       /*
+       TODO: Can we enable/disable these devices? How?
+       if (devices & VIA_LDVP0)
+       if (devices & VIA_LDVP1)
+       */
+       if (devices & VIA_DVP0)
+               set_dvp0_state(state);
+       if (devices & VIA_CRT)
+               set_crt_state(state);
+       if (devices & VIA_DVP1)
+               set_dvp1_state(state);
+       if (devices & VIA_LVDS1)
+               set_lvds1_state(state);
+       if (devices & VIA_LVDS2)
+               set_lvds2_state(state);
+}
 
-       case INTERFACE_DFP_LOW:
-               if (set_iga == IGA1)
-                       viafb_write_reg_mask(CR99, VIACR, 0x00, BIT4);
-               else {
-                       viafb_write_reg(CR91, VIACR, 0x00);
-                       viafb_write_reg_mask(CR99, VIACR, 0x10, BIT4);
-                       viafb_write_reg_mask(CR9B, VIACR, 0x10, BIT4);
-               }
+void via_set_sync_polarity(u32 devices, u8 polarity)
+{
+       if (polarity & ~(VIA_HSYNC_NEGATIVE | VIA_VSYNC_NEGATIVE)) {
+               printk(KERN_WARNING "viafb: Unsupported polarity: %d\n",
+                       polarity);
+               return;
+       }
 
-               break;
+       if (devices & VIA_CRT)
+               via_write_misc_reg_mask(polarity << 6, 0xC0);
+       if (devices & VIA_DVP1)
+               via_write_reg_mask(VIACR, 0x9B, polarity << 5, 0x60);
+       if (devices & VIA_LVDS1)
+               via_write_reg_mask(VIACR, 0x99, polarity << 5, 0x60);
+       if (devices & VIA_LVDS2)
+               via_write_reg_mask(VIACR, 0x97, polarity << 5, 0x60);
+}
 
-       case INTERFACE_DFP:
-               if ((UNICHROME_K8M890 == viaparinfo->chip_info->gfx_chip_name)
-                   || (UNICHROME_P4M890 ==
-                   viaparinfo->chip_info->gfx_chip_name))
-                       viafb_write_reg_mask(CR97, VIACR, 0x84,
-                                      BIT7 + BIT2 + BIT1 + BIT0);
-               if (set_iga == IGA1) {
-                       viafb_write_reg_mask(CR97, VIACR, 0x00, BIT4);
-                       viafb_write_reg_mask(CR99, VIACR, 0x00, BIT4);
-               } else {
-                       viafb_write_reg(CR91, VIACR, 0x00);
-                       viafb_write_reg_mask(CR97, VIACR, 0x10, BIT4);
-                       viafb_write_reg_mask(CR99, VIACR, 0x10, BIT4);
+u32 via_parse_odev(char *input, char **end)
+{
+       char *ptr = input;
+       u32 odev = 0;
+       bool next = true;
+       int i, len;
+
+       while (next) {
+               next = false;
+               for (i = 0; i < ARRAY_SIZE(device_mapping); i++) {
+                       len = strlen(device_mapping[i].name);
+                       if (!strncmp(ptr, device_mapping[i].name, len)) {
+                               odev |= device_mapping[i].device;
+                               ptr += len;
+                               if (*ptr == ',') {
+                                       ptr++;
+                                       next = true;
+                               }
+                       }
                }
-               break;
+       }
 
-       case INTERFACE_LVDS0:
-       case INTERFACE_LVDS0LVDS1:
-               if (set_iga == IGA1)
-                       viafb_write_reg_mask(CR99, VIACR, 0x00, BIT4);
-               else
-                       viafb_write_reg_mask(CR99, VIACR, 0x10, BIT4);
+       *end = ptr;
+       return odev;
+}
 
-               break;
+void via_odev_to_seq(struct seq_file *m, u32 odev)
+{
+       int i, count = 0;
 
-       case INTERFACE_LVDS1:
-               if (set_iga == IGA1)
-                       viafb_write_reg_mask(CR97, VIACR, 0x00, BIT4);
-               else
-                       viafb_write_reg_mask(CR97, VIACR, 0x10, BIT4);
-               break;
+       for (i = 0; i < ARRAY_SIZE(device_mapping); i++) {
+               if (odev & device_mapping[i].device) {
+                       if (count > 0)
+                               seq_putc(m, ',');
+
+                       seq_puts(m, device_mapping[i].name);
+                       count++;
+               }
        }
+
+       seq_putc(m, '\n');
 }
 
 static void load_fix_bit_crtc_reg(void)
@@ -1360,40 +1635,70 @@ void viafb_load_FIFO_reg(int set_iga, int hor_active, int ver_active)
 
 }
 
+static u32 cle266_encode_pll(struct pll_config pll)
+{
+       return (pll.multiplier << 8)
+               | (pll.rshift << 6)
+               | pll.divisor;
+}
+
+static u32 k800_encode_pll(struct pll_config pll)
+{
+       return ((pll.divisor - 2) << 16)
+               | (pll.rshift << 10)
+               | (pll.multiplier - 2);
+}
+
+static u32 vx855_encode_pll(struct pll_config pll)
+{
+       return (pll.divisor << 16)
+               | (pll.rshift << 10)
+               | pll.multiplier;
+}
+
 u32 viafb_get_clk_value(int clk)
 {
-       int i;
+       u32 value = 0;
+       int i = 0;
 
-       for (i = 0; i < NUM_TOTAL_PLL_TABLE; i++) {
-               if (clk == pll_value[i].clk) {
-                       switch (viaparinfo->chip_info->gfx_chip_name) {
-                       case UNICHROME_CLE266:
-                       case UNICHROME_K400:
-                               return pll_value[i].cle266_pll;
-
-                       case UNICHROME_K800:
-                       case UNICHROME_PM800:
-                       case UNICHROME_CN700:
-                               return pll_value[i].k800_pll;
-
-                       case UNICHROME_CX700:
-                       case UNICHROME_K8M890:
-                       case UNICHROME_P4M890:
-                       case UNICHROME_P4M900:
-                       case UNICHROME_VX800:
-                               return pll_value[i].cx700_pll;
-                       case UNICHROME_VX855:
-                               return pll_value[i].vx855_pll;
-                       }
+       while (i < NUM_TOTAL_PLL_TABLE && clk != pll_value[i].clk)
+               i++;
+
+       if (i == NUM_TOTAL_PLL_TABLE) {
+               printk(KERN_WARNING "viafb_get_clk_value: PLL lookup failed!");
+       } else {
+               switch (viaparinfo->chip_info->gfx_chip_name) {
+               case UNICHROME_CLE266:
+               case UNICHROME_K400:
+                       value = cle266_encode_pll(pll_value[i].cle266_pll);
+                       break;
+
+               case UNICHROME_K800:
+               case UNICHROME_PM800:
+               case UNICHROME_CN700:
+                       value = k800_encode_pll(pll_value[i].k800_pll);
+                       break;
+
+               case UNICHROME_CX700:
+               case UNICHROME_CN750:
+               case UNICHROME_K8M890:
+               case UNICHROME_P4M890:
+               case UNICHROME_P4M900:
+               case UNICHROME_VX800:
+                       value = k800_encode_pll(pll_value[i].cx700_pll);
+                       break;
+
+               case UNICHROME_VX855:
+                       value = vx855_encode_pll(pll_value[i].vx855_pll);
+                       break;
                }
        }
 
-       DEBUG_MSG(KERN_INFO "Can't find match PLL value\n\n");
-       return 0;
+       return value;
 }
 
 /* Set VCLK*/
-void viafb_set_vclock(u32 CLK, int set_iga)
+void viafb_set_vclock(u32 clk, int set_iga)
 {
        /* H.W. Reset : ON */
        viafb_write_reg_mask(CR17, VIACR, 0x00, BIT7);
@@ -1403,26 +1708,23 @@ void viafb_set_vclock(u32 CLK, int set_iga)
                switch (viaparinfo->chip_info->gfx_chip_name) {
                case UNICHROME_CLE266:
                case UNICHROME_K400:
-                       viafb_write_reg(SR46, VIASR, CLK / 0x100);
-                       viafb_write_reg(SR47, VIASR, CLK % 0x100);
+                       via_write_reg(VIASR, SR46, (clk & 0x00FF));
+                       via_write_reg(VIASR, SR47, (clk & 0xFF00) >> 8);
                        break;
 
                case UNICHROME_K800:
                case UNICHROME_PM800:
                case UNICHROME_CN700:
                case UNICHROME_CX700:
+               case UNICHROME_CN750:
                case UNICHROME_K8M890:
                case UNICHROME_P4M890:
                case UNICHROME_P4M900:
                case UNICHROME_VX800:
                case UNICHROME_VX855:
-                       viafb_write_reg(SR44, VIASR, CLK / 0x10000);
-                       DEBUG_MSG(KERN_INFO "\nSR44=%x", CLK / 0x10000);
-                       viafb_write_reg(SR45, VIASR, (CLK & 0xFFFF) / 0x100);
-                       DEBUG_MSG(KERN_INFO "\nSR45=%x",
-                                 (CLK & 0xFFFF) / 0x100);
-                       viafb_write_reg(SR46, VIASR, CLK % 0x100);
-                       DEBUG_MSG(KERN_INFO "\nSR46=%x", CLK % 0x100);
+                       via_write_reg(VIASR, SR44, (clk & 0x0000FF));
+                       via_write_reg(VIASR, SR45, (clk & 0x00FF00) >> 8);
+                       via_write_reg(VIASR, SR46, (clk & 0xFF0000) >> 16);
                        break;
                }
        }
@@ -1432,22 +1734,23 @@ void viafb_set_vclock(u32 CLK, int set_iga)
                switch (viaparinfo->chip_info->gfx_chip_name) {
                case UNICHROME_CLE266:
                case UNICHROME_K400:
-                       viafb_write_reg(SR44, VIASR, CLK / 0x100);
-                       viafb_write_reg(SR45, VIASR, CLK % 0x100);
+                       via_write_reg(VIASR, SR44, (clk & 0x00FF));
+                       via_write_reg(VIASR, SR45, (clk & 0xFF00) >> 8);
                        break;
 
                case UNICHROME_K800:
                case UNICHROME_PM800:
                case UNICHROME_CN700:
                case UNICHROME_CX700:
+               case UNICHROME_CN750:
                case UNICHROME_K8M890:
                case UNICHROME_P4M890:
                case UNICHROME_P4M900:
                case UNICHROME_VX800:
                case UNICHROME_VX855:
-                       viafb_write_reg(SR4A, VIASR, CLK / 0x10000);
-                       viafb_write_reg(SR4B, VIASR, (CLK & 0xFFFF) / 0x100);
-                       viafb_write_reg(SR4C, VIASR, CLK % 0x100);
+                       via_write_reg(VIASR, SR4A, (clk & 0x0000FF));
+                       via_write_reg(VIASR, SR4B, (clk & 0x00FF00) >> 8);
+                       via_write_reg(VIASR, SR4C, (clk & 0xFF0000) >> 16);
                        break;
                }
        }
@@ -1462,8 +1765,8 @@ void viafb_set_vclock(u32 CLK, int set_iga)
        }
 
        if (set_iga == IGA2) {
-               viafb_write_reg_mask(SR40, VIASR, 0x01, BIT0);
-               viafb_write_reg_mask(SR40, VIASR, 0x00, BIT0);
+               viafb_write_reg_mask(SR40, VIASR, 0x04, BIT2);
+               viafb_write_reg_mask(SR40, VIASR, 0x00, BIT2);
        }
 
        /* Fire! */
@@ -1711,7 +2014,6 @@ void viafb_fill_crtc_timing(struct crt_mode_table *crt_table,
        int index = 0;
        int h_addr, v_addr;
        u32 pll_D_N;
-       u8 polarity = 0;
 
        for (i = 0; i < video_mode->mode_array; i++) {
                index = i;
@@ -1738,14 +2040,6 @@ void viafb_fill_crtc_timing(struct crt_mode_table *crt_table,
 
        h_addr = crt_reg.hor_addr;
        v_addr = crt_reg.ver_addr;
-
-       /* update polarity for CRT timing */
-       if (crt_table[index].h_sync_polarity == NEGATIVE)
-               polarity |= BIT6;
-       if (crt_table[index].v_sync_polarity == NEGATIVE)
-               polarity |= BIT7;
-       via_write_misc_reg_mask(polarity, BIT6 | BIT7);
-
        if (set_iga == IGA1) {
                viafb_unlock_crt();
                viafb_write_reg(CR09, VIACR, 0x00);     /*initial CR09=0 */
@@ -1778,7 +2072,7 @@ void viafb_fill_crtc_timing(struct crt_mode_table *crt_table,
 
 }
 
-void viafb_init_chip_info(int chip_type)
+void __devinit viafb_init_chip_info(int chip_type)
 {
        init_gfx_chip_info(chip_type);
        init_tmds_chip_info();
@@ -1791,8 +2085,6 @@ void viafb_init_chip_info(int chip_type)
        viafb_set_iga_path();
 
        viaparinfo->lvds_setting_info->display_method = viafb_lcd_dsp_method;
-       viaparinfo->lvds_setting_info->get_lcd_size_method =
-               GET_LCD_SIZE_BY_USER_SETTING;
        viaparinfo->lvds_setting_info->lcd_mode = viafb_lcd_mode;
        viaparinfo->lvds_setting_info2->display_method =
                viaparinfo->lvds_setting_info->display_method;
@@ -1847,7 +2139,7 @@ void viafb_update_device_setting(int hres, int vres,
        }
 }
 
-static void init_gfx_chip_info(int chip_type)
+static void __devinit init_gfx_chip_info(int chip_type)
 {
        u8 tmp;
 
@@ -1899,7 +2191,7 @@ static void init_gfx_chip_info(int chip_type)
        }
 }
 
-static void init_tmds_chip_info(void)
+static void __devinit init_tmds_chip_info(void)
 {
        viafb_tmds_trasmitter_identify();
 
@@ -1944,15 +2236,8 @@ static void init_tmds_chip_info(void)
                &viaparinfo->shared->tmds_setting_info);
 }
 
-static void init_lvds_chip_info(void)
+static void __devinit init_lvds_chip_info(void)
 {
-       if (viafb_lcd_panel_id > LCD_PANEL_ID_MAXIMUM)
-               viaparinfo->lvds_setting_info->get_lcd_size_method =
-                   GET_LCD_SIZE_BY_VGA_BIOS;
-       else
-               viaparinfo->lvds_setting_info->get_lcd_size_method =
-                   GET_LCD_SIZE_BY_USER_SETTING;
-
        viafb_lvds_trasmitter_identify();
        viafb_init_lcd_size();
        viafb_init_lvds_output_interface(&viaparinfo->chip_info->lvds_chip_info,
@@ -1985,7 +2270,7 @@ static void init_lvds_chip_info(void)
                  viaparinfo->chip_info->lvds_chip_info.output_interface);
 }
 
-void viafb_init_dac(int set_iga)
+void __devinit viafb_init_dac(int set_iga)
 {
        int i;
        u8 tmp;
@@ -2058,11 +2343,24 @@ static void set_display_channel(void)
        }
 }
 
+static u8 get_sync(struct fb_info *info)
+{
+       u8 polarity = 0;
+
+       if (!(info->var.sync & FB_SYNC_HOR_HIGH_ACT))
+               polarity |= VIA_HSYNC_NEGATIVE;
+       if (!(info->var.sync & FB_SYNC_VERT_HIGH_ACT))
+               polarity |= VIA_VSYNC_NEGATIVE;
+       return polarity;
+}
+
 int viafb_setmode(struct VideoModeTable *vmode_tbl, int video_bpp,
        struct VideoModeTable *vmode_tbl1, int video_bpp1)
 {
        int i, j;
        int port;
+       u32 devices = viaparinfo->shared->iga1_devices
+               | viaparinfo->shared->iga2_devices;
        u8 value, index, mask;
        struct crt_mode_table *crt_timing;
        struct crt_mode_table *crt_timing1 = NULL;
@@ -2110,6 +2408,7 @@ int viafb_setmode(struct VideoModeTable *vmode_tbl, int video_bpp,
        }
 
        device_off();
+       via_set_state(devices, VIA_STATE_OFF);
 
        /* Fill VPIT Parameters */
        /* Write Misc Register */
@@ -2120,7 +2419,6 @@ int viafb_setmode(struct VideoModeTable *vmode_tbl, int video_bpp,
                via_write_reg(VIASR, i, VPIT.SR[i - 1]);
 
        viafb_write_reg_mask(0x15, VIASR, 0xA2, 0xA2);
-       viafb_set_iga_path();
 
        /* Write CRTC */
        viafb_fill_crtc_timing(crt_timing, vmode_tbl, video_bpp / 8, IGA1);
@@ -2160,6 +2458,13 @@ int viafb_setmode(struct VideoModeTable *vmode_tbl, int video_bpp,
        via_set_primary_color_depth(viaparinfo->depth);
        via_set_secondary_color_depth(viafb_dual_fb ? viaparinfo1->depth
                : viaparinfo->depth);
+       via_set_source(viaparinfo->shared->iga1_devices, IGA1);
+       via_set_source(viaparinfo->shared->iga2_devices, IGA2);
+       if (viaparinfo->shared->iga2_devices)
+               enable_second_display_channel();
+       else
+               disable_second_display_channel();
+
        /* Update Refresh Rate Setting */
 
        /* Clear On Screen */
@@ -2177,8 +2482,6 @@ int viafb_setmode(struct VideoModeTable *vmode_tbl, int video_bpp,
                                viaparinfo->crt_setting_info->iga_path);
                }
 
-               set_crt_output_path(viaparinfo->crt_setting_info->iga_path);
-
                /* Patch if set_hres is not 8 alignment (1366) to viafb_setmode
                to 8 alignment (1368),there is several pixels (2 pixels)
                on right side of screen. */
@@ -2265,10 +2568,16 @@ int viafb_setmode(struct VideoModeTable *vmode_tbl, int video_bpp,
                        viafb_DeviceStatus = CRT_Device;
        }
        device_on();
+       if (!viafb_dual_fb)
+               via_set_sync_polarity(devices, get_sync(viafbinfo));
+       else {
+               via_set_sync_polarity(viaparinfo->shared->iga1_devices,
+                       get_sync(viafbinfo));
+               via_set_sync_polarity(viaparinfo->shared->iga2_devices,
+                       get_sync(viafbinfo1));
+       }
 
-       if (viafb_SAMM_ON == 1)
-               viafb_write_reg_mask(CR6A, VIACR, 0xC0, BIT6 + BIT7);
-
+       via_set_state(devices, VIA_STATE_ON);
        device_screen_on();
        return 1;
 }
@@ -2309,31 +2618,18 @@ int viafb_get_refresh(int hres, int vres, u32 long_refresh)
 
 static void device_off(void)
 {
-       viafb_crt_disable();
        viafb_dvi_disable();
        viafb_lcd_disable();
 }
 
 static void device_on(void)
 {
-       if (viafb_CRT_ON == 1)
-               viafb_crt_enable();
        if (viafb_DVI_ON == 1)
                viafb_dvi_enable();
        if (viafb_LCD_ON == 1)
                viafb_lcd_enable();
 }
 
-void viafb_crt_disable(void)
-{
-       viafb_write_reg_mask(CR36, VIACR, BIT5 + BIT4, BIT5 + BIT4);
-}
-
-void viafb_crt_enable(void)
-{
-       viafb_write_reg_mask(CR36, VIACR, 0x0, BIT5 + BIT4);
-}
-
 static void enable_second_display_channel(void)
 {
        /* to enable second display channel. */
@@ -2350,7 +2646,6 @@ static void disable_second_display_channel(void)
        viafb_write_reg_mask(CR6A, VIACR, BIT6, BIT6);
 }
 
-
 void viafb_set_dpa_gfx(int output_interface, struct GFX_DPA_SETTING\
                                        *p_gfx_dpa_setting)
 {
@@ -2435,4 +2730,9 @@ void viafb_fill_var_timing_info(struct fb_var_screeninfo *var, int refresh,
            crt_reg.ver_total - (crt_reg.ver_sync_start + crt_reg.ver_sync_end);
        var->lower_margin = crt_reg.ver_sync_start - crt_reg.ver_addr;
        var->vsync_len = crt_reg.ver_sync_end;
+       var->sync = 0;
+       if (crt_timing[index].h_sync_polarity == POSITIVE)
+               var->sync |= FB_SYNC_HOR_HIGH_ACT;
+       if (crt_timing[index].v_sync_polarity == POSITIVE)
+               var->sync |= FB_SYNC_VERT_HIGH_ACT;
 }