Fix up the radeon i2c error handing

1 files changed, 14 insertions, 19 deletions

diff --git a/linux-2.6/radeon_i2c.c b/linux-2.6/radeon_i2c.c
index 9fdb2b4f..d116b381 100644
--- a/linux-2.6/radeon_i2c.c
+++ b/linux-2.6/radeon_i2c.c
@@ -82,10 +82,11 @@ static int gpio_getsda(void* data)
 	return (val & VGA_DDC_DATA_INPUT) ? 1 : 0;
 }
 
-static int setup_i2c_bus(struct radeon_i2c_chan *chan, const char *name)
+static int setup_i2c_bus(drm_device_t * dev, struct radeon_i2c_chan *chan, const char *name)
 {
 	int rc;
 
+	chan->dev = dev;
 	strcpy(chan->adapter.name, name);
 	chan->adapter.owner		= THIS_MODULE;
 	chan->adapter.id		= I2C_ALGO_ATI;
@@ -106,39 +107,33 @@ static int setup_i2c_bus(struct radeon_i2c_chan *chan, const char *name)
 	gpio_setscl(chan, 1);
 	udelay(20);
 
-	rc = i2c_bit_add_bus(&chan->adapter);
-	if (rc == 0)
-		DRM_DEBUG("I2C bus %s registered.\n", name);
-	else
+	if ((rc = i2c_bit_add_bus(&chan->adapter))) {
+		i2c_set_adapdata(&chan->adapter, NULL);
+		chan->dev = NULL;
 		DRM_ERROR("Failed to register I2C bus %s.\n", name);
-	return rc;
+		return rc;
+	}
+	DRM_DEBUG("I2C bus %s registered.\n", name);
+	return 0;
 }
 
 int radeon_create_i2c_busses(drm_device_t * dev)
 {
 	drm_radeon_private_t *dev_priv = dev->dev_private;
 
-	dev_priv->i2c[0].dev = dev;
 	dev_priv->i2c[0].ddc_reg = GPIO_MONID;
 	/* Don't return the error from setup. It is not fatal */
 	/* if the bus can not be initialized */
-	if (!setup_i2c_bus(&dev_priv->i2c[0], "monid"))
-		dev_priv->i2c[0].dev = NULL;
+	setup_i2c_bus(dev, &dev_priv->i2c[0], "monid");
 
-	dev_priv->i2c[1].dev = dev;
 	dev_priv->i2c[1].ddc_reg = GPIO_DVI_DDC;
-	if (!setup_i2c_bus(&dev_priv->i2c[1], "dvi"))
-		dev_priv->i2c[1].dev = NULL;
+	setup_i2c_bus(dev, &dev_priv->i2c[1], "dvi");
 
-	dev_priv->i2c[2].dev = dev;
 	dev_priv->i2c[2].ddc_reg = GPIO_VGA_DDC;
-	if (!setup_i2c_bus(&dev_priv->i2c[2], "vga"))
-		dev_priv->i2c[2].dev = NULL;
+	setup_i2c_bus(dev, &dev_priv->i2c[2], "vga");
 
-	dev_priv->i2c[3].dev = dev;
 	dev_priv->i2c[3].ddc_reg = GPIO_CRT2_DDC;
-	if (!setup_i2c_bus(&dev_priv->i2c[3], "crt2"))
-		dev_priv->i2c[0].dev = NULL;
+	setup_i2c_bus(dev, &dev_priv->i2c[3], "crt2");
 
 	return 0;
 }
@@ -151,8 +146,8 @@ void radeon_delete_i2c_busses(drm_device_t *dev)
 	for (i = 0; i < 4; i++) {
 		if (dev_priv->i2c[i].dev) {
 			ret = i2c_bit_del_bus(&dev_priv->i2c[i].adapter);
+			dev_priv->i2c[i].dev = NULL;
 		}
-		dev_priv->i2c[i].dev = NULL;
 	}
 }