Add the two GPL licensed I2C support files.
Jon Smirl
parent
0c6fb0fbe1
commit
f10f882101
|
|
@ -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);
|
||||
|
||||
|
||||
|
|
@ -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;
|
||||
}
|
||||
}
|
||||
Loading…
Reference in New Issue