1 files changed, 27 insertions, 0 deletions

diff --git a/drivers/video/via/viafbdev.c b/drivers/video/via/viafbdev.c
index a13c258bd32f..6d5b64923236 100644
--- a/drivers/video/via/viafbdev.c
+++ b/drivers/video/via/viafbdev.c
@@ -24,6 +24,7 @@
 #include <linux/slab.h>
 #include <linux/stat.h>
 #include <linux/via-core.h>
+#include <linux/via_i2c.h>
 #include <asm/olpc.h>
 
 #define _MASTER_FILE
@@ -1729,6 +1730,29 @@ static struct viafb_pm_hooks viafb_fb_pm_hooks = {
 
 #endif
 
+static void __devinit i2c_bus_probe(struct viafb_shared *shared)
+{
+        /* should be always CRT */
+        printk(KERN_INFO "viafb: Probing I2C bus 0x26\n");
+        shared->i2c_26 = via_aux_probe(viafb_find_i2c_adapter(VIA_PORT_26));
+
+        /* seems to be usually DVP1 */
+        printk(KERN_INFO "viafb: Probing I2C bus 0x31\n");
+        shared->i2c_31 = via_aux_probe(viafb_find_i2c_adapter(VIA_PORT_31));
+
+        /* FIXME: what is this? */
+        printk(KERN_INFO "viafb: Probing I2C bus 0x2C\n");
+        shared->i2c_2C = via_aux_probe(viafb_find_i2c_adapter(VIA_PORT_2C));
+
+        printk(KERN_INFO "viafb: Finished I2C bus probing");
+}
+
+static void i2c_bus_free(struct viafb_shared *shared)
+{
+        via_aux_free(shared->i2c_26);
+        via_aux_free(shared->i2c_31);
+        via_aux_free(shared->i2c_2C);
+}
 
 int __devinit via_fb_pci_probe(struct viafb_dev *vdev)
 {
@@ -1762,6 +1786,7 @@ int __devinit via_fb_pci_probe(struct viafb_dev *vdev)
                 &viaparinfo->shared->lvds_setting_info2;
         viaparinfo->chip_info = &viaparinfo->shared->chip_info;
 
+        i2c_bus_probe(viaparinfo->shared);
         if (viafb_dual_fb)
                 viafb_SAMM_ON = 1;
         parse_lcd_port();
@@ -1915,6 +1940,7 @@ out_fb1_release:
         if (viafbinfo1)
                 framebuffer_release(viafbinfo1);
 out_fb_release:
+        i2c_bus_free(viaparinfo->shared);
         framebuffer_release(viafbinfo);
         return rc;
 }
@@ -1927,6 +1953,7 @@ void __devexit via_fb_pci_remove(struct pci_dev *pdev)
         if (viafb_dual_fb)
                 unregister_framebuffer(viafbinfo1);
         viafb_remove_proc(viaparinfo->shared);
+        i2c_bus_free(viaparinfo->shared);
         framebuffer_release(viafbinfo);
         if (viafb_dual_fb)
                 framebuffer_release(viafbinfo1);