geemili
/
drm
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fix up the radeon i2c error handing

main
Jon Smirl 2004-10-21 16:58:28 +00:00
parent 17ce33835a
commit d76f734f68
2 changed files with 39 additions and 49 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

33
linux-2.6/radeon_i2c.c
View File

@ -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;
}
}

55
linux-core/radeon_i2c.c
View File

@ -81,22 +81,23 @@ 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;
chan->adapter.algo_data = &chan->algo;
chan->adapter.dev.parent = &chan->dev->pdev->dev;
chan->algo.setsda = gpio_setsda;
chan->algo.setscl = gpio_setscl;
chan->algo.getsda = gpio_getsda;
chan->algo.getscl = gpio_getscl;
chan->algo.udelay = 40;
chan->algo.timeout = 20;
chan->algo.data = chan;
chan->adapter.owner = THIS_MODULE;
chan->adapter.id = I2C_ALGO_ATI;
chan->adapter.algo_data = &chan->algo;
chan->adapter.dev.parent = &chan->dev->pdev->dev;
chan->algo.setsda = gpio_setsda;
chan->algo.setscl = gpio_setscl;
chan->algo.getsda = gpio_getsda;
chan->algo.getscl = gpio_getscl;
chan->algo.udelay = 40;
chan->algo.timeout = 20;
chan->algo.data = chan;
i2c_set_adapdata(&chan->adapter, chan);
@ -105,39 +106,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;
}
@ -150,8 +145,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;
}
}