158 lines
3.6 KiB
C
158 lines
3.6 KiB
C
/*
|
|
* 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 <linux/version.h>
|
|
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
|
|
|
#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;
|
|
}
|
|
}
|
|
|
|
#endif
|