diff options
| -rw-r--r-- | linux/radeon_gpl.h | 29 | ||||
| -rw-r--r-- | linux/radeon_i2c.c | 152 |
2 files changed, 181 insertions, 0 deletions
diff --git a/linux/radeon_gpl.h b/linux/radeon_gpl.h new file mode 100644 index 00000000..e8c479a1 --- /dev/null +++ b/linux/radeon_gpl.h @@ -0,0 +1,29 @@ +/* + * linux/radeon_gpl.h + * + * Original author probably Benjamin Herrenschmidt <benh@kernel.crashing.org> + * or Kronos <kronos@kronoz.cjb.net> + * Based on Xfree sources + * (C) Copyright 2004 Jon Smirl <jonsmirl@gmail.com> + * + * This is a GPL licensed file from the Linux kernel, don't add it to the BSD build + * + * Radeon I2C support routines + * + */ + +#include <linux/i2c.h> +#include <linux/i2c-id.h> +#include <linux/i2c-algo-bit.h> + +struct radeon_i2c_chan { + drm_device_t *dev; + u32 ddc_reg; + struct i2c_adapter adapter; + struct i2c_algo_bit_data algo; +}; + +extern int radeon_create_i2c_busses(drm_device_t *dev); +extern void radeon_delete_i2c_busses(drm_device_t *dev); + + diff --git a/linux/radeon_i2c.c b/linux/radeon_i2c.c new file mode 100644 index 00000000..a68b9ee1 --- /dev/null +++ b/linux/radeon_i2c.c @@ -0,0 +1,152 @@ +/* + * linux/radeon_i2c.c + * + * Original author probably Benjamin Herrenschmidt <benh@kernel.crashing.org> + * or Kronos <kronos@kronoz.cjb.net> + * Based on Xfree sources + * (C) Copyright 2004 Jon Smirl <jonsmirl@gmail.com> + * + * This is a GPL licensed file from the Linux kernel, don't add it to the BSD build + * + * Radeon I2C support routines + * + */ + +#include <linux/config.h> +#include <linux/module.h> +#include <linux/kernel.h> +#include <linux/sched.h> +#include <linux/delay.h> +#include <linux/pci.h> +#include <linux/fb.h> + +#include <asm/io.h> +#include <video/radeon.h> + +#include "radeon.h" +#include "drmP.h" +#include "drm.h" +#include "radeon_drm.h" +#include "radeon_drv.h" + +static void gpio_setscl(void* data, int state) +{ + struct radeon_i2c_chan *chan = data; + drm_radeon_private_t *dev_priv = chan->dev->dev_private; + u32 val; + + val = RADEON_READ(chan->ddc_reg) & ~(VGA_DDC_CLK_OUT_EN); + if (!state) + val |= VGA_DDC_CLK_OUT_EN; + + RADEON_WRITE(chan->ddc_reg, val); + (void)RADEON_READ(chan->ddc_reg); +} + +static void gpio_setsda(void* data, int state) +{ + struct radeon_i2c_chan *chan = data; + drm_radeon_private_t *dev_priv = chan->dev->dev_private; + u32 val; + + val = RADEON_READ(chan->ddc_reg) & ~(VGA_DDC_DATA_OUT_EN); + if (!state) + val |= VGA_DDC_DATA_OUT_EN; + + RADEON_WRITE(chan->ddc_reg, val); + (void)RADEON_READ(chan->ddc_reg); +} + +static int gpio_getscl(void* data) +{ + struct radeon_i2c_chan *chan = data; + drm_radeon_private_t *dev_priv = chan->dev->dev_private; + u32 val; + + val = RADEON_READ(chan->ddc_reg); + + return (val & VGA_DDC_CLK_INPUT) ? 1 : 0; +} + +static int gpio_getsda(void* data) +{ + struct radeon_i2c_chan *chan = data; + drm_radeon_private_t *dev_priv = chan->dev->dev_private; + u32 val; + + val = RADEON_READ(chan->ddc_reg); + + return (val & VGA_DDC_DATA_INPUT) ? 1 : 0; +} + +static int setup_i2c_bus(struct radeon_i2c_chan *chan, const char *name) +{ + int rc; + + 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; + + i2c_set_adapdata(&chan->adapter, chan); + + /* Raise SCL and SDA */ + gpio_setsda(chan, 1); + 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 + DRM_ERROR("Failed to register I2C bus %s.\n", name); + return rc; +} + +int radeon_create_i2c_busses(drm_device_t *dev) +{ + drm_radeon_private_t *dev_priv = dev->dev_private; + int ret; + + dev_priv->i2c[0].dev = dev; + dev_priv->i2c[0].ddc_reg = GPIO_MONID; + if ((ret = setup_i2c_bus(&dev_priv->i2c[0], "monid"))) + return ret; + + dev_priv->i2c[1].dev = dev; + dev_priv->i2c[1].ddc_reg = GPIO_DVI_DDC; + if ((ret = setup_i2c_bus(&dev_priv->i2c[1], "dvi"))) + return ret; + + dev_priv->i2c[2].dev = dev; + dev_priv->i2c[2].ddc_reg = GPIO_VGA_DDC; + if ((ret = setup_i2c_bus(&dev_priv->i2c[2], "vga"))) + return ret; + + dev_priv->i2c[3].dev = dev; + dev_priv->i2c[3].ddc_reg = GPIO_CRT2_DDC; + if ((ret = setup_i2c_bus(&dev_priv->i2c[3], "crt2"))) + return ret; + return 0; +} + +void radeon_delete_i2c_busses(drm_device_t *dev) +{ + drm_radeon_private_t *dev_priv = dev->dev_private; + int i, ret; + + 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; + } +} |