592ffb2175
Revert r338177, r338176, r338175, r338174, r338172 After long consultations with re@, core members and mmacy, revert these changes. Followup changes will be made to mark them as deprecated and prent a message about where to find the up-to-date driver. Followup commits will be made to make this clear in the installer. Followup commits to reduce POLA in ways we're still exploring. It's anticipated that after the freeze, this will be removed in 13-current (with the residual of the drm2 code copied to sys/arm/dev/drm2 for the TEGRA port's use w/o the intel or radeon drivers). Due to the impending freeze, there was no formal core vote for this. I've been talking to different core members all day, as well as Matt Macey and Glen Barber. Nobody is completely happy, all are grudgingly going along with this. Work is in progress to mitigate the negative effects as much as possible. Requested by: re@ (gjb, rgrimes)
1385 lines
34 KiB
C
1385 lines
34 KiB
C
/*
|
|
* Copyright 2007-8 Advanced Micro Devices, Inc.
|
|
* Copyright 2008 Red Hat Inc.
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
|
|
* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
|
|
* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
|
* OTHER DEALINGS IN THE SOFTWARE.
|
|
*
|
|
* Authors: Dave Airlie
|
|
* Alex Deucher
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <dev/drm2/drmP.h>
|
|
#include <dev/drm2/drm_edid.h>
|
|
#include <dev/drm2/radeon/radeon_drm.h>
|
|
#include <dev/iicbus/iic.h>
|
|
#include <dev/iicbus/iiconf.h>
|
|
#include <dev/iicbus/iicbus.h>
|
|
#include "radeon.h"
|
|
#include "atom.h"
|
|
#include "iicbus_if.h"
|
|
#include "iicbb_if.h"
|
|
|
|
/**
|
|
* radeon_ddc_probe
|
|
*
|
|
*/
|
|
bool radeon_ddc_probe(struct radeon_connector *radeon_connector, bool use_aux)
|
|
{
|
|
u8 out = 0x0;
|
|
u8 buf[8];
|
|
int ret;
|
|
struct iic_msg msgs[] = {
|
|
{
|
|
.slave = DDC_ADDR << 1,
|
|
.flags = 0,
|
|
.len = 1,
|
|
.buf = &out,
|
|
},
|
|
{
|
|
.slave = DDC_ADDR << 1,
|
|
.flags = IIC_M_RD,
|
|
.len = 8,
|
|
.buf = buf,
|
|
}
|
|
};
|
|
|
|
/* on hw with routers, select right port */
|
|
if (radeon_connector->router.ddc_valid)
|
|
radeon_router_select_ddc_port(radeon_connector);
|
|
|
|
if (use_aux) {
|
|
struct radeon_connector_atom_dig *dig = radeon_connector->con_priv;
|
|
ret = iicbus_transfer(dig->dp_i2c_bus->adapter, msgs, 2);
|
|
} else {
|
|
ret = iicbus_transfer(radeon_connector->ddc_bus->adapter, msgs, 2);
|
|
}
|
|
|
|
if (ret != 0)
|
|
/* Couldn't find an accessible DDC on this connector */
|
|
return false;
|
|
/* Probe also for valid EDID header
|
|
* EDID header starts with:
|
|
* 0x00,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0x00.
|
|
* Only the first 6 bytes must be valid as
|
|
* drm_edid_block_valid() can fix the last 2 bytes */
|
|
if (drm_edid_header_is_valid(buf) < 6) {
|
|
/* Couldn't find an accessible EDID on this
|
|
* connector */
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
/* bit banging i2c */
|
|
|
|
static int radeon_iicbb_pre_xfer(device_t dev)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
uint32_t temp;
|
|
|
|
/* RV410 appears to have a bug where the hw i2c in reset
|
|
* holds the i2c port in a bad state - switch hw i2c away before
|
|
* doing DDC - do this for all r200s/r300s/r400s for safety sake
|
|
*/
|
|
if (rec->hw_capable) {
|
|
if ((rdev->family >= CHIP_R200) && !ASIC_IS_AVIVO(rdev)) {
|
|
u32 reg;
|
|
|
|
if (rdev->family >= CHIP_RV350)
|
|
reg = RADEON_GPIO_MONID;
|
|
else if ((rdev->family == CHIP_R300) ||
|
|
(rdev->family == CHIP_R350))
|
|
reg = RADEON_GPIO_DVI_DDC;
|
|
else
|
|
reg = RADEON_GPIO_CRT2_DDC;
|
|
|
|
sx_xlock(&rdev->dc_hw_i2c_mutex);
|
|
if (rec->a_clk_reg == reg) {
|
|
WREG32(RADEON_DVI_I2C_CNTL_0, (RADEON_I2C_SOFT_RST |
|
|
R200_DVI_I2C_PIN_SEL(R200_SEL_DDC1)));
|
|
} else {
|
|
WREG32(RADEON_DVI_I2C_CNTL_0, (RADEON_I2C_SOFT_RST |
|
|
R200_DVI_I2C_PIN_SEL(R200_SEL_DDC3)));
|
|
}
|
|
sx_xunlock(&rdev->dc_hw_i2c_mutex);
|
|
}
|
|
}
|
|
|
|
/* switch the pads to ddc mode */
|
|
if (ASIC_IS_DCE3(rdev) && rec->hw_capable) {
|
|
temp = RREG32(rec->mask_clk_reg);
|
|
temp &= ~(1 << 16);
|
|
WREG32(rec->mask_clk_reg, temp);
|
|
}
|
|
|
|
/* clear the output pin values */
|
|
temp = RREG32(rec->a_clk_reg) & ~rec->a_clk_mask;
|
|
WREG32(rec->a_clk_reg, temp);
|
|
|
|
temp = RREG32(rec->a_data_reg) & ~rec->a_data_mask;
|
|
WREG32(rec->a_data_reg, temp);
|
|
|
|
/* set the pins to input */
|
|
temp = RREG32(rec->en_clk_reg) & ~rec->en_clk_mask;
|
|
WREG32(rec->en_clk_reg, temp);
|
|
|
|
temp = RREG32(rec->en_data_reg) & ~rec->en_data_mask;
|
|
WREG32(rec->en_data_reg, temp);
|
|
|
|
/* mask the gpio pins for software use */
|
|
temp = RREG32(rec->mask_clk_reg) | rec->mask_clk_mask;
|
|
WREG32(rec->mask_clk_reg, temp);
|
|
temp = RREG32(rec->mask_clk_reg);
|
|
|
|
temp = RREG32(rec->mask_data_reg) | rec->mask_data_mask;
|
|
WREG32(rec->mask_data_reg, temp);
|
|
temp = RREG32(rec->mask_data_reg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void radeon_iicbb_post_xfer(device_t dev)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
uint32_t temp;
|
|
|
|
/* unmask the gpio pins for software use */
|
|
temp = RREG32(rec->mask_clk_reg) & ~rec->mask_clk_mask;
|
|
WREG32(rec->mask_clk_reg, temp);
|
|
temp = RREG32(rec->mask_clk_reg);
|
|
|
|
temp = RREG32(rec->mask_data_reg) & ~rec->mask_data_mask;
|
|
WREG32(rec->mask_data_reg, temp);
|
|
temp = RREG32(rec->mask_data_reg);
|
|
}
|
|
|
|
static int radeon_iicbb_get_clock(device_t dev)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
uint32_t val;
|
|
|
|
/* read the value off the pin */
|
|
val = RREG32(rec->y_clk_reg);
|
|
val &= rec->y_clk_mask;
|
|
|
|
return (val != 0);
|
|
}
|
|
|
|
|
|
static int radeon_iicbb_get_data(device_t dev)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
uint32_t val;
|
|
|
|
/* read the value off the pin */
|
|
val = RREG32(rec->y_data_reg);
|
|
val &= rec->y_data_mask;
|
|
|
|
return (val != 0);
|
|
}
|
|
|
|
static void radeon_iicbb_set_clock(device_t dev, int clock)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
uint32_t val;
|
|
|
|
/* set pin direction */
|
|
val = RREG32(rec->en_clk_reg) & ~rec->en_clk_mask;
|
|
val |= clock ? 0 : rec->en_clk_mask;
|
|
WREG32(rec->en_clk_reg, val);
|
|
}
|
|
|
|
static void radeon_iicbb_set_data(device_t dev, int data)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
uint32_t val;
|
|
|
|
/* set pin direction */
|
|
val = RREG32(rec->en_data_reg) & ~rec->en_data_mask;
|
|
val |= data ? 0 : rec->en_data_mask;
|
|
WREG32(rec->en_data_reg, val);
|
|
}
|
|
|
|
static int
|
|
radeon_iicbb_probe(device_t dev)
|
|
{
|
|
|
|
return (BUS_PROBE_DEFAULT);
|
|
}
|
|
|
|
static int
|
|
radeon_iicbb_attach(device_t dev)
|
|
{
|
|
struct radeon_i2c_chan *i2c;
|
|
device_t iic_dev;
|
|
|
|
i2c = device_get_softc(dev);
|
|
device_set_desc(dev, i2c->name);
|
|
|
|
/* add generic bit-banging code */
|
|
iic_dev = device_add_child(dev, "iicbb", -1);
|
|
if (iic_dev == NULL)
|
|
return (ENXIO);
|
|
device_quiet(iic_dev);
|
|
|
|
/* attach and probe added child */
|
|
bus_generic_attach(dev);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
radeon_iicbb_detach(device_t dev)
|
|
{
|
|
|
|
/* detach bit-banding code. */
|
|
bus_generic_detach(dev);
|
|
|
|
/* delete bit-banding code. */
|
|
device_delete_children(dev);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
radeon_iicbb_reset(device_t dev, u_char speed, u_char addr, u_char *oldaddr)
|
|
{
|
|
|
|
/* Not sure what to do here. */
|
|
return 0;
|
|
}
|
|
|
|
static device_method_t radeon_iicbb_methods[] = {
|
|
DEVMETHOD(device_probe, radeon_iicbb_probe),
|
|
DEVMETHOD(device_attach, radeon_iicbb_attach),
|
|
DEVMETHOD(device_detach, radeon_iicbb_detach),
|
|
|
|
DEVMETHOD(bus_add_child, bus_generic_add_child),
|
|
DEVMETHOD(bus_print_child, bus_generic_print_child),
|
|
|
|
DEVMETHOD(iicbb_reset, radeon_iicbb_reset),
|
|
DEVMETHOD(iicbb_pre_xfer, radeon_iicbb_pre_xfer),
|
|
DEVMETHOD(iicbb_post_xfer, radeon_iicbb_post_xfer),
|
|
DEVMETHOD(iicbb_setsda, radeon_iicbb_set_data),
|
|
DEVMETHOD(iicbb_setscl, radeon_iicbb_set_clock),
|
|
DEVMETHOD(iicbb_getsda, radeon_iicbb_get_data),
|
|
DEVMETHOD(iicbb_getscl, radeon_iicbb_get_clock),
|
|
DEVMETHOD_END
|
|
};
|
|
|
|
static driver_t radeon_iicbb_driver = {
|
|
"radeon_iicbb",
|
|
radeon_iicbb_methods,
|
|
0 /* softc will be allocated by parent */
|
|
};
|
|
static devclass_t radeon_iicbb_devclass;
|
|
DRIVER_MODULE_ORDERED(radeon_iicbb, drmn, radeon_iicbb_driver,
|
|
radeon_iicbb_devclass, 0, 0, SI_ORDER_FIRST);
|
|
DRIVER_MODULE(iicbb, radeon_iicbb, iicbb_driver, iicbb_devclass, 0, 0);
|
|
|
|
/* hw i2c */
|
|
|
|
static u32 radeon_get_i2c_prescale(struct radeon_device *rdev)
|
|
{
|
|
u32 sclk = rdev->pm.current_sclk;
|
|
u32 prescale = 0;
|
|
u32 nm;
|
|
u8 n, m, loop;
|
|
int i2c_clock;
|
|
|
|
switch (rdev->family) {
|
|
case CHIP_R100:
|
|
case CHIP_RV100:
|
|
case CHIP_RS100:
|
|
case CHIP_RV200:
|
|
case CHIP_RS200:
|
|
case CHIP_R200:
|
|
case CHIP_RV250:
|
|
case CHIP_RS300:
|
|
case CHIP_RV280:
|
|
case CHIP_R300:
|
|
case CHIP_R350:
|
|
case CHIP_RV350:
|
|
i2c_clock = 60;
|
|
nm = (sclk * 10) / (i2c_clock * 4);
|
|
for (loop = 1; loop < 255; loop++) {
|
|
if ((nm / loop) < loop)
|
|
break;
|
|
}
|
|
n = loop - 1;
|
|
m = loop - 2;
|
|
prescale = m | (n << 8);
|
|
break;
|
|
case CHIP_RV380:
|
|
case CHIP_RS400:
|
|
case CHIP_RS480:
|
|
case CHIP_R420:
|
|
case CHIP_R423:
|
|
case CHIP_RV410:
|
|
prescale = (((sclk * 10)/(4 * 128 * 100) + 1) << 8) + 128;
|
|
break;
|
|
case CHIP_RS600:
|
|
case CHIP_RS690:
|
|
case CHIP_RS740:
|
|
/* todo */
|
|
break;
|
|
case CHIP_RV515:
|
|
case CHIP_R520:
|
|
case CHIP_RV530:
|
|
case CHIP_RV560:
|
|
case CHIP_RV570:
|
|
case CHIP_R580:
|
|
i2c_clock = 50;
|
|
if (rdev->family == CHIP_R520)
|
|
prescale = (127 << 8) + ((sclk * 10) / (4 * 127 * i2c_clock));
|
|
else
|
|
prescale = (((sclk * 10)/(4 * 128 * 100) + 1) << 8) + 128;
|
|
break;
|
|
case CHIP_R600:
|
|
case CHIP_RV610:
|
|
case CHIP_RV630:
|
|
case CHIP_RV670:
|
|
/* todo */
|
|
break;
|
|
case CHIP_RV620:
|
|
case CHIP_RV635:
|
|
case CHIP_RS780:
|
|
case CHIP_RS880:
|
|
case CHIP_RV770:
|
|
case CHIP_RV730:
|
|
case CHIP_RV710:
|
|
case CHIP_RV740:
|
|
/* todo */
|
|
break;
|
|
case CHIP_CEDAR:
|
|
case CHIP_REDWOOD:
|
|
case CHIP_JUNIPER:
|
|
case CHIP_CYPRESS:
|
|
case CHIP_HEMLOCK:
|
|
/* todo */
|
|
break;
|
|
default:
|
|
DRM_ERROR("i2c: unhandled radeon chip\n");
|
|
break;
|
|
}
|
|
return prescale;
|
|
}
|
|
|
|
|
|
/* hw i2c engine for r1xx-4xx hardware
|
|
* hw can buffer up to 15 bytes
|
|
*/
|
|
static int r100_hw_i2c_xfer(struct radeon_i2c_chan *i2c,
|
|
struct iic_msg *msgs, int num)
|
|
{
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
struct iic_msg *p;
|
|
int i, j, k, ret = 0;
|
|
u32 prescale;
|
|
u32 i2c_cntl_0, i2c_cntl_1, i2c_data;
|
|
u32 tmp, reg;
|
|
|
|
sx_xlock(&rdev->dc_hw_i2c_mutex);
|
|
/* take the pm lock since we need a constant sclk */
|
|
sx_xlock(&rdev->pm.mutex);
|
|
|
|
prescale = radeon_get_i2c_prescale(rdev);
|
|
|
|
reg = ((prescale << RADEON_I2C_PRESCALE_SHIFT) |
|
|
RADEON_I2C_DRIVE_EN |
|
|
RADEON_I2C_START |
|
|
RADEON_I2C_STOP |
|
|
RADEON_I2C_GO);
|
|
|
|
if (rdev->is_atom_bios) {
|
|
tmp = RREG32(RADEON_BIOS_6_SCRATCH);
|
|
WREG32(RADEON_BIOS_6_SCRATCH, tmp | ATOM_S6_HW_I2C_BUSY_STATE);
|
|
}
|
|
|
|
if (rec->mm_i2c) {
|
|
i2c_cntl_0 = RADEON_I2C_CNTL_0;
|
|
i2c_cntl_1 = RADEON_I2C_CNTL_1;
|
|
i2c_data = RADEON_I2C_DATA;
|
|
} else {
|
|
i2c_cntl_0 = RADEON_DVI_I2C_CNTL_0;
|
|
i2c_cntl_1 = RADEON_DVI_I2C_CNTL_1;
|
|
i2c_data = RADEON_DVI_I2C_DATA;
|
|
|
|
switch (rdev->family) {
|
|
case CHIP_R100:
|
|
case CHIP_RV100:
|
|
case CHIP_RS100:
|
|
case CHIP_RV200:
|
|
case CHIP_RS200:
|
|
case CHIP_RS300:
|
|
switch (rec->mask_clk_reg) {
|
|
case RADEON_GPIO_DVI_DDC:
|
|
/* no gpio select bit */
|
|
break;
|
|
default:
|
|
DRM_ERROR("gpio not supported with hw i2c\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
break;
|
|
case CHIP_R200:
|
|
/* only bit 4 on r200 */
|
|
switch (rec->mask_clk_reg) {
|
|
case RADEON_GPIO_DVI_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC1);
|
|
break;
|
|
case RADEON_GPIO_MONID:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC3);
|
|
break;
|
|
default:
|
|
DRM_ERROR("gpio not supported with hw i2c\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
break;
|
|
case CHIP_RV250:
|
|
case CHIP_RV280:
|
|
/* bits 3 and 4 */
|
|
switch (rec->mask_clk_reg) {
|
|
case RADEON_GPIO_DVI_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC1);
|
|
break;
|
|
case RADEON_GPIO_VGA_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC2);
|
|
break;
|
|
case RADEON_GPIO_CRT2_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC3);
|
|
break;
|
|
default:
|
|
DRM_ERROR("gpio not supported with hw i2c\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
break;
|
|
case CHIP_R300:
|
|
case CHIP_R350:
|
|
/* only bit 4 on r300/r350 */
|
|
switch (rec->mask_clk_reg) {
|
|
case RADEON_GPIO_VGA_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC1);
|
|
break;
|
|
case RADEON_GPIO_DVI_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC3);
|
|
break;
|
|
default:
|
|
DRM_ERROR("gpio not supported with hw i2c\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
break;
|
|
case CHIP_RV350:
|
|
case CHIP_RV380:
|
|
case CHIP_R420:
|
|
case CHIP_R423:
|
|
case CHIP_RV410:
|
|
case CHIP_RS400:
|
|
case CHIP_RS480:
|
|
/* bits 3 and 4 */
|
|
switch (rec->mask_clk_reg) {
|
|
case RADEON_GPIO_VGA_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC1);
|
|
break;
|
|
case RADEON_GPIO_DVI_DDC:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC2);
|
|
break;
|
|
case RADEON_GPIO_MONID:
|
|
reg |= R200_DVI_I2C_PIN_SEL(R200_SEL_DDC3);
|
|
break;
|
|
default:
|
|
DRM_ERROR("gpio not supported with hw i2c\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
break;
|
|
default:
|
|
DRM_ERROR("unsupported asic\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* check for bus probe */
|
|
p = &msgs[0];
|
|
if ((num == 1) && (p->len == 0)) {
|
|
WREG32(i2c_cntl_0, (RADEON_I2C_DONE |
|
|
RADEON_I2C_NACK |
|
|
RADEON_I2C_HALT |
|
|
RADEON_I2C_SOFT_RST));
|
|
WREG32(i2c_data, (p->slave << 1) & 0xff);
|
|
WREG32(i2c_data, 0);
|
|
WREG32(i2c_cntl_1, ((1 << RADEON_I2C_DATA_COUNT_SHIFT) |
|
|
(1 << RADEON_I2C_ADDR_COUNT_SHIFT) |
|
|
RADEON_I2C_EN |
|
|
(48 << RADEON_I2C_TIME_LIMIT_SHIFT)));
|
|
WREG32(i2c_cntl_0, reg);
|
|
for (k = 0; k < 32; k++) {
|
|
udelay(10);
|
|
tmp = RREG32(i2c_cntl_0);
|
|
if (tmp & RADEON_I2C_GO)
|
|
continue;
|
|
tmp = RREG32(i2c_cntl_0);
|
|
if (tmp & RADEON_I2C_DONE)
|
|
break;
|
|
else {
|
|
DRM_DEBUG("i2c write error 0x%08x\n", tmp);
|
|
WREG32(i2c_cntl_0, tmp | RADEON_I2C_ABORT);
|
|
ret = -EIO;
|
|
goto done;
|
|
}
|
|
}
|
|
goto done;
|
|
}
|
|
|
|
for (i = 0; i < num; i++) {
|
|
p = &msgs[i];
|
|
for (j = 0; j < p->len; j++) {
|
|
if (p->flags & IIC_M_RD) {
|
|
WREG32(i2c_cntl_0, (RADEON_I2C_DONE |
|
|
RADEON_I2C_NACK |
|
|
RADEON_I2C_HALT |
|
|
RADEON_I2C_SOFT_RST));
|
|
WREG32(i2c_data, ((p->slave << 1) & 0xff) | 0x1);
|
|
WREG32(i2c_cntl_1, ((1 << RADEON_I2C_DATA_COUNT_SHIFT) |
|
|
(1 << RADEON_I2C_ADDR_COUNT_SHIFT) |
|
|
RADEON_I2C_EN |
|
|
(48 << RADEON_I2C_TIME_LIMIT_SHIFT)));
|
|
WREG32(i2c_cntl_0, reg | RADEON_I2C_RECEIVE);
|
|
for (k = 0; k < 32; k++) {
|
|
udelay(10);
|
|
tmp = RREG32(i2c_cntl_0);
|
|
if (tmp & RADEON_I2C_GO)
|
|
continue;
|
|
tmp = RREG32(i2c_cntl_0);
|
|
if (tmp & RADEON_I2C_DONE)
|
|
break;
|
|
else {
|
|
DRM_DEBUG("i2c read error 0x%08x\n", tmp);
|
|
WREG32(i2c_cntl_0, tmp | RADEON_I2C_ABORT);
|
|
ret = -EIO;
|
|
goto done;
|
|
}
|
|
}
|
|
p->buf[j] = RREG32(i2c_data) & 0xff;
|
|
} else {
|
|
WREG32(i2c_cntl_0, (RADEON_I2C_DONE |
|
|
RADEON_I2C_NACK |
|
|
RADEON_I2C_HALT |
|
|
RADEON_I2C_SOFT_RST));
|
|
WREG32(i2c_data, (p->slave << 1) & 0xff);
|
|
WREG32(i2c_data, p->buf[j]);
|
|
WREG32(i2c_cntl_1, ((1 << RADEON_I2C_DATA_COUNT_SHIFT) |
|
|
(1 << RADEON_I2C_ADDR_COUNT_SHIFT) |
|
|
RADEON_I2C_EN |
|
|
(48 << RADEON_I2C_TIME_LIMIT_SHIFT)));
|
|
WREG32(i2c_cntl_0, reg);
|
|
for (k = 0; k < 32; k++) {
|
|
udelay(10);
|
|
tmp = RREG32(i2c_cntl_0);
|
|
if (tmp & RADEON_I2C_GO)
|
|
continue;
|
|
tmp = RREG32(i2c_cntl_0);
|
|
if (tmp & RADEON_I2C_DONE)
|
|
break;
|
|
else {
|
|
DRM_DEBUG("i2c write error 0x%08x\n", tmp);
|
|
WREG32(i2c_cntl_0, tmp | RADEON_I2C_ABORT);
|
|
ret = -EIO;
|
|
goto done;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
done:
|
|
WREG32(i2c_cntl_0, 0);
|
|
WREG32(i2c_cntl_1, 0);
|
|
WREG32(i2c_cntl_0, (RADEON_I2C_DONE |
|
|
RADEON_I2C_NACK |
|
|
RADEON_I2C_HALT |
|
|
RADEON_I2C_SOFT_RST));
|
|
|
|
if (rdev->is_atom_bios) {
|
|
tmp = RREG32(RADEON_BIOS_6_SCRATCH);
|
|
tmp &= ~ATOM_S6_HW_I2C_BUSY_STATE;
|
|
WREG32(RADEON_BIOS_6_SCRATCH, tmp);
|
|
}
|
|
|
|
sx_xunlock(&rdev->pm.mutex);
|
|
sx_xunlock(&rdev->dc_hw_i2c_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* hw i2c engine for r5xx hardware
|
|
* hw can buffer up to 15 bytes
|
|
*/
|
|
static int r500_hw_i2c_xfer(struct radeon_i2c_chan *i2c,
|
|
struct iic_msg *msgs, int num)
|
|
{
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
struct iic_msg *p;
|
|
int i, j, remaining, current_count, buffer_offset, ret = 0;
|
|
u32 prescale;
|
|
u32 tmp, reg;
|
|
u32 saved1, saved2;
|
|
|
|
sx_xlock(&rdev->dc_hw_i2c_mutex);
|
|
/* take the pm lock since we need a constant sclk */
|
|
sx_xlock(&rdev->pm.mutex);
|
|
|
|
prescale = radeon_get_i2c_prescale(rdev);
|
|
|
|
/* clear gpio mask bits */
|
|
tmp = RREG32(rec->mask_clk_reg);
|
|
tmp &= ~rec->mask_clk_mask;
|
|
WREG32(rec->mask_clk_reg, tmp);
|
|
tmp = RREG32(rec->mask_clk_reg);
|
|
|
|
tmp = RREG32(rec->mask_data_reg);
|
|
tmp &= ~rec->mask_data_mask;
|
|
WREG32(rec->mask_data_reg, tmp);
|
|
tmp = RREG32(rec->mask_data_reg);
|
|
|
|
/* clear pin values */
|
|
tmp = RREG32(rec->a_clk_reg);
|
|
tmp &= ~rec->a_clk_mask;
|
|
WREG32(rec->a_clk_reg, tmp);
|
|
tmp = RREG32(rec->a_clk_reg);
|
|
|
|
tmp = RREG32(rec->a_data_reg);
|
|
tmp &= ~rec->a_data_mask;
|
|
WREG32(rec->a_data_reg, tmp);
|
|
tmp = RREG32(rec->a_data_reg);
|
|
|
|
/* set the pins to input */
|
|
tmp = RREG32(rec->en_clk_reg);
|
|
tmp &= ~rec->en_clk_mask;
|
|
WREG32(rec->en_clk_reg, tmp);
|
|
tmp = RREG32(rec->en_clk_reg);
|
|
|
|
tmp = RREG32(rec->en_data_reg);
|
|
tmp &= ~rec->en_data_mask;
|
|
WREG32(rec->en_data_reg, tmp);
|
|
tmp = RREG32(rec->en_data_reg);
|
|
|
|
/* */
|
|
tmp = RREG32(RADEON_BIOS_6_SCRATCH);
|
|
WREG32(RADEON_BIOS_6_SCRATCH, tmp | ATOM_S6_HW_I2C_BUSY_STATE);
|
|
saved1 = RREG32(AVIVO_DC_I2C_CONTROL1);
|
|
saved2 = RREG32(0x494);
|
|
WREG32(0x494, saved2 | 0x1);
|
|
|
|
WREG32(AVIVO_DC_I2C_ARBITRATION, AVIVO_DC_I2C_SW_WANTS_TO_USE_I2C);
|
|
for (i = 0; i < 50; i++) {
|
|
udelay(1);
|
|
if (RREG32(AVIVO_DC_I2C_ARBITRATION) & AVIVO_DC_I2C_SW_CAN_USE_I2C)
|
|
break;
|
|
}
|
|
if (i == 50) {
|
|
DRM_ERROR("failed to get i2c bus\n");
|
|
ret = -EBUSY;
|
|
goto done;
|
|
}
|
|
|
|
reg = AVIVO_DC_I2C_START | AVIVO_DC_I2C_STOP | AVIVO_DC_I2C_EN;
|
|
switch (rec->mask_clk_reg) {
|
|
case AVIVO_DC_GPIO_DDC1_MASK:
|
|
reg |= AVIVO_DC_I2C_PIN_SELECT(AVIVO_SEL_DDC1);
|
|
break;
|
|
case AVIVO_DC_GPIO_DDC2_MASK:
|
|
reg |= AVIVO_DC_I2C_PIN_SELECT(AVIVO_SEL_DDC2);
|
|
break;
|
|
case AVIVO_DC_GPIO_DDC3_MASK:
|
|
reg |= AVIVO_DC_I2C_PIN_SELECT(AVIVO_SEL_DDC3);
|
|
break;
|
|
default:
|
|
DRM_ERROR("gpio not supported with hw i2c\n");
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
|
|
/* check for bus probe */
|
|
p = &msgs[0];
|
|
if ((num == 1) && (p->len == 0)) {
|
|
WREG32(AVIVO_DC_I2C_STATUS1, (AVIVO_DC_I2C_DONE |
|
|
AVIVO_DC_I2C_NACK |
|
|
AVIVO_DC_I2C_HALT));
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_SOFT_RESET);
|
|
udelay(1);
|
|
WREG32(AVIVO_DC_I2C_RESET, 0);
|
|
|
|
WREG32(AVIVO_DC_I2C_DATA, (p->slave << 1) & 0xff);
|
|
WREG32(AVIVO_DC_I2C_DATA, 0);
|
|
|
|
WREG32(AVIVO_DC_I2C_CONTROL3, AVIVO_DC_I2C_TIME_LIMIT(48));
|
|
WREG32(AVIVO_DC_I2C_CONTROL2, (AVIVO_DC_I2C_ADDR_COUNT(1) |
|
|
AVIVO_DC_I2C_DATA_COUNT(1) |
|
|
(prescale << 16)));
|
|
WREG32(AVIVO_DC_I2C_CONTROL1, reg);
|
|
WREG32(AVIVO_DC_I2C_STATUS1, AVIVO_DC_I2C_GO);
|
|
for (j = 0; j < 200; j++) {
|
|
udelay(50);
|
|
tmp = RREG32(AVIVO_DC_I2C_STATUS1);
|
|
if (tmp & AVIVO_DC_I2C_GO)
|
|
continue;
|
|
tmp = RREG32(AVIVO_DC_I2C_STATUS1);
|
|
if (tmp & AVIVO_DC_I2C_DONE)
|
|
break;
|
|
else {
|
|
DRM_DEBUG("i2c write error 0x%08x\n", tmp);
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_ABORT);
|
|
ret = -EIO;
|
|
goto done;
|
|
}
|
|
}
|
|
goto done;
|
|
}
|
|
|
|
for (i = 0; i < num; i++) {
|
|
p = &msgs[i];
|
|
remaining = p->len;
|
|
buffer_offset = 0;
|
|
if (p->flags & IIC_M_RD) {
|
|
while (remaining) {
|
|
if (remaining > 15)
|
|
current_count = 15;
|
|
else
|
|
current_count = remaining;
|
|
WREG32(AVIVO_DC_I2C_STATUS1, (AVIVO_DC_I2C_DONE |
|
|
AVIVO_DC_I2C_NACK |
|
|
AVIVO_DC_I2C_HALT));
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_SOFT_RESET);
|
|
udelay(1);
|
|
WREG32(AVIVO_DC_I2C_RESET, 0);
|
|
|
|
WREG32(AVIVO_DC_I2C_DATA, ((p->slave << 1) & 0xff) | 0x1);
|
|
WREG32(AVIVO_DC_I2C_CONTROL3, AVIVO_DC_I2C_TIME_LIMIT(48));
|
|
WREG32(AVIVO_DC_I2C_CONTROL2, (AVIVO_DC_I2C_ADDR_COUNT(1) |
|
|
AVIVO_DC_I2C_DATA_COUNT(current_count) |
|
|
(prescale << 16)));
|
|
WREG32(AVIVO_DC_I2C_CONTROL1, reg | AVIVO_DC_I2C_RECEIVE);
|
|
WREG32(AVIVO_DC_I2C_STATUS1, AVIVO_DC_I2C_GO);
|
|
for (j = 0; j < 200; j++) {
|
|
udelay(50);
|
|
tmp = RREG32(AVIVO_DC_I2C_STATUS1);
|
|
if (tmp & AVIVO_DC_I2C_GO)
|
|
continue;
|
|
tmp = RREG32(AVIVO_DC_I2C_STATUS1);
|
|
if (tmp & AVIVO_DC_I2C_DONE)
|
|
break;
|
|
else {
|
|
DRM_DEBUG("i2c read error 0x%08x\n", tmp);
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_ABORT);
|
|
ret = -EIO;
|
|
goto done;
|
|
}
|
|
}
|
|
for (j = 0; j < current_count; j++)
|
|
p->buf[buffer_offset + j] = RREG32(AVIVO_DC_I2C_DATA) & 0xff;
|
|
remaining -= current_count;
|
|
buffer_offset += current_count;
|
|
}
|
|
} else {
|
|
while (remaining) {
|
|
if (remaining > 15)
|
|
current_count = 15;
|
|
else
|
|
current_count = remaining;
|
|
WREG32(AVIVO_DC_I2C_STATUS1, (AVIVO_DC_I2C_DONE |
|
|
AVIVO_DC_I2C_NACK |
|
|
AVIVO_DC_I2C_HALT));
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_SOFT_RESET);
|
|
udelay(1);
|
|
WREG32(AVIVO_DC_I2C_RESET, 0);
|
|
|
|
WREG32(AVIVO_DC_I2C_DATA, (p->slave << 1) & 0xff);
|
|
for (j = 0; j < current_count; j++)
|
|
WREG32(AVIVO_DC_I2C_DATA, p->buf[buffer_offset + j]);
|
|
|
|
WREG32(AVIVO_DC_I2C_CONTROL3, AVIVO_DC_I2C_TIME_LIMIT(48));
|
|
WREG32(AVIVO_DC_I2C_CONTROL2, (AVIVO_DC_I2C_ADDR_COUNT(1) |
|
|
AVIVO_DC_I2C_DATA_COUNT(current_count) |
|
|
(prescale << 16)));
|
|
WREG32(AVIVO_DC_I2C_CONTROL1, reg);
|
|
WREG32(AVIVO_DC_I2C_STATUS1, AVIVO_DC_I2C_GO);
|
|
for (j = 0; j < 200; j++) {
|
|
udelay(50);
|
|
tmp = RREG32(AVIVO_DC_I2C_STATUS1);
|
|
if (tmp & AVIVO_DC_I2C_GO)
|
|
continue;
|
|
tmp = RREG32(AVIVO_DC_I2C_STATUS1);
|
|
if (tmp & AVIVO_DC_I2C_DONE)
|
|
break;
|
|
else {
|
|
DRM_DEBUG("i2c write error 0x%08x\n", tmp);
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_ABORT);
|
|
ret = -EIO;
|
|
goto done;
|
|
}
|
|
}
|
|
remaining -= current_count;
|
|
buffer_offset += current_count;
|
|
}
|
|
}
|
|
}
|
|
|
|
done:
|
|
WREG32(AVIVO_DC_I2C_STATUS1, (AVIVO_DC_I2C_DONE |
|
|
AVIVO_DC_I2C_NACK |
|
|
AVIVO_DC_I2C_HALT));
|
|
WREG32(AVIVO_DC_I2C_RESET, AVIVO_DC_I2C_SOFT_RESET);
|
|
udelay(1);
|
|
WREG32(AVIVO_DC_I2C_RESET, 0);
|
|
|
|
WREG32(AVIVO_DC_I2C_ARBITRATION, AVIVO_DC_I2C_SW_DONE_USING_I2C);
|
|
WREG32(AVIVO_DC_I2C_CONTROL1, saved1);
|
|
WREG32(0x494, saved2);
|
|
tmp = RREG32(RADEON_BIOS_6_SCRATCH);
|
|
tmp &= ~ATOM_S6_HW_I2C_BUSY_STATE;
|
|
WREG32(RADEON_BIOS_6_SCRATCH, tmp);
|
|
|
|
sx_xunlock(&rdev->pm.mutex);
|
|
sx_xunlock(&rdev->dc_hw_i2c_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int radeon_hw_i2c_xfer(device_t dev,
|
|
struct iic_msg *msgs, uint32_t num)
|
|
{
|
|
struct radeon_i2c_chan *i2c = device_get_softc(dev);
|
|
struct radeon_device *rdev = i2c->dev->dev_private;
|
|
struct radeon_i2c_bus_rec *rec = &i2c->rec;
|
|
int ret = 0;
|
|
|
|
switch (rdev->family) {
|
|
case CHIP_R100:
|
|
case CHIP_RV100:
|
|
case CHIP_RS100:
|
|
case CHIP_RV200:
|
|
case CHIP_RS200:
|
|
case CHIP_R200:
|
|
case CHIP_RV250:
|
|
case CHIP_RS300:
|
|
case CHIP_RV280:
|
|
case CHIP_R300:
|
|
case CHIP_R350:
|
|
case CHIP_RV350:
|
|
case CHIP_RV380:
|
|
case CHIP_R420:
|
|
case CHIP_R423:
|
|
case CHIP_RV410:
|
|
case CHIP_RS400:
|
|
case CHIP_RS480:
|
|
ret = r100_hw_i2c_xfer(i2c, msgs, num);
|
|
break;
|
|
case CHIP_RS600:
|
|
case CHIP_RS690:
|
|
case CHIP_RS740:
|
|
/* XXX fill in hw i2c implementation */
|
|
break;
|
|
case CHIP_RV515:
|
|
case CHIP_R520:
|
|
case CHIP_RV530:
|
|
case CHIP_RV560:
|
|
case CHIP_RV570:
|
|
case CHIP_R580:
|
|
if (rec->mm_i2c)
|
|
ret = r100_hw_i2c_xfer(i2c, msgs, num);
|
|
else
|
|
ret = r500_hw_i2c_xfer(i2c, msgs, num);
|
|
break;
|
|
case CHIP_R600:
|
|
case CHIP_RV610:
|
|
case CHIP_RV630:
|
|
case CHIP_RV670:
|
|
/* XXX fill in hw i2c implementation */
|
|
break;
|
|
case CHIP_RV620:
|
|
case CHIP_RV635:
|
|
case CHIP_RS780:
|
|
case CHIP_RS880:
|
|
case CHIP_RV770:
|
|
case CHIP_RV730:
|
|
case CHIP_RV710:
|
|
case CHIP_RV740:
|
|
/* XXX fill in hw i2c implementation */
|
|
break;
|
|
case CHIP_CEDAR:
|
|
case CHIP_REDWOOD:
|
|
case CHIP_JUNIPER:
|
|
case CHIP_CYPRESS:
|
|
case CHIP_HEMLOCK:
|
|
/* XXX fill in hw i2c implementation */
|
|
break;
|
|
default:
|
|
DRM_ERROR("i2c: unhandled radeon chip\n");
|
|
ret = -EIO;
|
|
break;
|
|
}
|
|
|
|
return -ret;
|
|
}
|
|
|
|
static int
|
|
radeon_hw_i2c_probe(device_t dev)
|
|
{
|
|
|
|
return (BUS_PROBE_SPECIFIC);
|
|
}
|
|
|
|
static int
|
|
radeon_hw_i2c_attach(device_t dev)
|
|
{
|
|
struct radeon_i2c_chan *i2c;
|
|
device_t iic_dev;
|
|
|
|
i2c = device_get_softc(dev);
|
|
device_set_desc(dev, i2c->name);
|
|
|
|
/* add generic bit-banging code */
|
|
iic_dev = device_add_child(dev, "iicbus", -1);
|
|
if (iic_dev == NULL)
|
|
return (ENXIO);
|
|
device_quiet(iic_dev);
|
|
|
|
/* attach and probe added child */
|
|
bus_generic_attach(dev);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
radeon_hw_i2c_detach(device_t dev)
|
|
{
|
|
|
|
/* detach bit-banding code. */
|
|
bus_generic_detach(dev);
|
|
|
|
/* delete bit-banding code. */
|
|
device_delete_children(dev);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
radeon_hw_i2c_reset(device_t dev, u_char speed, u_char addr, u_char *oldaddr)
|
|
{
|
|
|
|
/* Not sure what to do here. */
|
|
return 0;
|
|
}
|
|
|
|
|
|
static device_method_t radeon_hw_i2c_methods[] = {
|
|
DEVMETHOD(device_probe, radeon_hw_i2c_probe),
|
|
DEVMETHOD(device_attach, radeon_hw_i2c_attach),
|
|
DEVMETHOD(device_detach, radeon_hw_i2c_detach),
|
|
DEVMETHOD(iicbus_reset, radeon_hw_i2c_reset),
|
|
DEVMETHOD(iicbus_transfer, radeon_hw_i2c_xfer),
|
|
DEVMETHOD_END
|
|
};
|
|
|
|
static driver_t radeon_hw_i2c_driver = {
|
|
"radeon_hw_i2c",
|
|
radeon_hw_i2c_methods,
|
|
0 /* softc will be allocated by parent */
|
|
};
|
|
|
|
static devclass_t radeon_hw_i2c_devclass;
|
|
DRIVER_MODULE_ORDERED(radeon_hw_i2c, drm, radeon_hw_i2c_driver,
|
|
radeon_hw_i2c_devclass, 0, 0, SI_ORDER_FIRST);
|
|
DRIVER_MODULE(iicbus, radeon_hw_i2c, iicbus_driver, iicbus_devclass, 0, 0);
|
|
|
|
struct radeon_i2c_chan *radeon_i2c_create(struct drm_device *dev,
|
|
struct radeon_i2c_bus_rec *rec,
|
|
const char *name)
|
|
{
|
|
struct radeon_device *rdev = dev->dev_private;
|
|
struct radeon_i2c_chan *i2c;
|
|
device_t iicbus_dev;
|
|
int ret;
|
|
|
|
/* don't add the mm_i2c bus unless hw_i2c is enabled */
|
|
if (rec->mm_i2c && (radeon_hw_i2c == 0))
|
|
return NULL;
|
|
|
|
i2c = malloc(sizeof(struct radeon_i2c_chan),
|
|
DRM_MEM_DRIVER, M_NOWAIT | M_ZERO);
|
|
if (i2c == NULL)
|
|
return NULL;
|
|
|
|
/*
|
|
* Grab Giant before messing with newbus devices, just in case
|
|
* we do not hold it already.
|
|
*/
|
|
mtx_lock(&Giant);
|
|
|
|
i2c->rec = *rec;
|
|
i2c->dev = dev;
|
|
if (rec->mm_i2c ||
|
|
(rec->hw_capable &&
|
|
radeon_hw_i2c &&
|
|
((rdev->family <= CHIP_RS480) ||
|
|
((rdev->family >= CHIP_RV515) && (rdev->family <= CHIP_R580))))) {
|
|
/* set the radeon hw i2c adapter */
|
|
snprintf(i2c->name, sizeof(i2c->name),
|
|
"Radeon i2c hw bus %s", name);
|
|
iicbus_dev = device_add_child(dev->dev, "radeon_hw_i2c", -1);
|
|
if (iicbus_dev == NULL) {
|
|
DRM_ERROR("Failed to create bridge for hw i2c %s\n",
|
|
name);
|
|
goto out_free;
|
|
}
|
|
device_quiet(iicbus_dev);
|
|
device_set_softc(iicbus_dev, i2c);
|
|
|
|
ret = device_probe_and_attach(iicbus_dev);
|
|
if (ret != 0) {
|
|
DRM_ERROR("Attach failed for bridge for hw i2c %s\n",
|
|
name);
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
|
|
i2c->adapter = device_find_child(iicbus_dev, "iicbus", -1);
|
|
if (i2c->adapter == NULL) {
|
|
DRM_ERROR("hw i2c bridge doesn't have iicbus child\n");
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
} else if (rec->hw_capable &&
|
|
radeon_hw_i2c &&
|
|
ASIC_IS_DCE3(rdev)) {
|
|
/* hw i2c using atom */
|
|
snprintf(i2c->name, sizeof(i2c->name),
|
|
"Radeon i2c hw bus %s", name);
|
|
iicbus_dev = device_add_child(dev->dev, "radeon_atom_hw_i2c", -1);
|
|
if (iicbus_dev == NULL) {
|
|
DRM_ERROR("Failed to create bridge for hw i2c %s\n",
|
|
name);
|
|
goto out_free;
|
|
}
|
|
device_quiet(iicbus_dev);
|
|
device_set_softc(iicbus_dev, i2c);
|
|
|
|
ret = device_probe_and_attach(iicbus_dev);
|
|
if (ret != 0) {
|
|
DRM_ERROR("Attach failed for bridge for hw i2c %s\n",
|
|
name);
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
|
|
i2c->adapter = device_find_child(iicbus_dev, "iicbus", -1);
|
|
if (i2c->adapter == NULL) {
|
|
DRM_ERROR("hw i2c bridge doesn't have iicbus child\n");
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
} else {
|
|
device_t iicbb_dev;
|
|
|
|
/* set the radeon bit adapter */
|
|
snprintf(i2c->name, sizeof(i2c->name),
|
|
"Radeon i2c bit bus %s", name);
|
|
iicbus_dev = device_add_child(dev->dev, "radeon_iicbb", -1);
|
|
if (iicbus_dev == NULL) {
|
|
DRM_ERROR("Failed to create bridge for bb i2c %s\n",
|
|
name);
|
|
goto out_free;
|
|
}
|
|
device_quiet(iicbus_dev);
|
|
device_set_softc(iicbus_dev, i2c);
|
|
|
|
ret = device_probe_and_attach(iicbus_dev);
|
|
if (ret != 0) {
|
|
DRM_ERROR("Attach failed for bridge for bb i2c %s\n",
|
|
name);
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
|
|
iicbb_dev = device_find_child(iicbus_dev, "iicbb", -1);
|
|
if (iicbb_dev == NULL) {
|
|
DRM_ERROR("bb i2c bridge doesn't have iicbb child\n");
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
|
|
i2c->adapter = device_find_child(iicbb_dev, "iicbus", -1);
|
|
if (i2c->adapter == NULL) {
|
|
DRM_ERROR(
|
|
"bbbus bridge doesn't have iicbus grandchild\n");
|
|
device_delete_child(dev->dev, iicbus_dev);
|
|
goto out_free;
|
|
}
|
|
}
|
|
|
|
i2c->iic_bus = iicbus_dev;
|
|
|
|
mtx_unlock(&Giant);
|
|
|
|
return i2c;
|
|
out_free:
|
|
mtx_unlock(&Giant);
|
|
free(i2c, DRM_MEM_DRIVER);
|
|
return NULL;
|
|
|
|
}
|
|
|
|
struct radeon_i2c_chan *radeon_i2c_create_dp(struct drm_device *dev,
|
|
struct radeon_i2c_bus_rec *rec,
|
|
const char *name)
|
|
{
|
|
struct radeon_i2c_chan *i2c;
|
|
int ret;
|
|
|
|
i2c = malloc(sizeof(struct radeon_i2c_chan),
|
|
DRM_MEM_DRIVER, M_NOWAIT | M_ZERO);
|
|
if (i2c == NULL)
|
|
return NULL;
|
|
|
|
i2c->rec = *rec;
|
|
i2c->dev = dev;
|
|
snprintf(i2c->name, sizeof(i2c->name),
|
|
"Radeon aux bus %s", name);
|
|
ret = iic_dp_aux_add_bus(dev->dev, i2c->name,
|
|
radeon_dp_i2c_aux_ch, i2c, &i2c->iic_bus,
|
|
&i2c->adapter);
|
|
if (ret) {
|
|
DRM_INFO("Failed to register i2c %s\n", name);
|
|
goto out_free;
|
|
}
|
|
|
|
return i2c;
|
|
out_free:
|
|
free(i2c, DRM_MEM_DRIVER);
|
|
return NULL;
|
|
|
|
}
|
|
|
|
void radeon_i2c_destroy(struct radeon_i2c_chan *i2c)
|
|
{
|
|
if (!i2c)
|
|
return;
|
|
if (i2c->iic_bus != NULL) {
|
|
int ret;
|
|
|
|
mtx_lock(&Giant);
|
|
ret = device_delete_child(i2c->dev->dev, i2c->iic_bus);
|
|
mtx_unlock(&Giant);
|
|
KASSERT(ret == 0, ("unable to detach iic bus %s: %d",
|
|
i2c->name, ret));
|
|
}
|
|
free(i2c, DRM_MEM_DRIVER);
|
|
}
|
|
|
|
/* Add the default buses */
|
|
void radeon_i2c_init(struct radeon_device *rdev)
|
|
{
|
|
if (rdev->is_atom_bios)
|
|
radeon_atombios_i2c_init(rdev);
|
|
else
|
|
radeon_combios_i2c_init(rdev);
|
|
}
|
|
|
|
/* remove all the buses */
|
|
void radeon_i2c_fini(struct radeon_device *rdev)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < RADEON_MAX_I2C_BUS; i++) {
|
|
if (rdev->i2c_bus[i]) {
|
|
radeon_i2c_destroy(rdev->i2c_bus[i]);
|
|
rdev->i2c_bus[i] = NULL;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Add additional buses */
|
|
void radeon_i2c_add(struct radeon_device *rdev,
|
|
struct radeon_i2c_bus_rec *rec,
|
|
const char *name)
|
|
{
|
|
struct drm_device *dev = rdev->ddev;
|
|
int i;
|
|
|
|
for (i = 0; i < RADEON_MAX_I2C_BUS; i++) {
|
|
if (!rdev->i2c_bus[i]) {
|
|
rdev->i2c_bus[i] = radeon_i2c_create(dev, rec, name);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* looks up bus based on id */
|
|
struct radeon_i2c_chan *radeon_i2c_lookup(struct radeon_device *rdev,
|
|
struct radeon_i2c_bus_rec *i2c_bus)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < RADEON_MAX_I2C_BUS; i++) {
|
|
if (rdev->i2c_bus[i] &&
|
|
(rdev->i2c_bus[i]->rec.i2c_id == i2c_bus->i2c_id)) {
|
|
return rdev->i2c_bus[i];
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
struct drm_encoder *radeon_best_encoder(struct drm_connector *connector)
|
|
{
|
|
return NULL;
|
|
}
|
|
|
|
void radeon_i2c_get_byte(struct radeon_i2c_chan *i2c_bus,
|
|
u8 slave_addr,
|
|
u8 addr,
|
|
u8 *val)
|
|
{
|
|
u8 out_buf[2];
|
|
u8 in_buf[2];
|
|
struct iic_msg msgs[] = {
|
|
{
|
|
.slave = slave_addr << 1,
|
|
.flags = 0,
|
|
.len = 1,
|
|
.buf = out_buf,
|
|
},
|
|
{
|
|
.slave = slave_addr << 1,
|
|
.flags = IIC_M_RD,
|
|
.len = 1,
|
|
.buf = in_buf,
|
|
}
|
|
};
|
|
|
|
out_buf[0] = addr;
|
|
out_buf[1] = 0;
|
|
|
|
if (iicbus_transfer(i2c_bus->adapter, msgs, 2) == 0) {
|
|
*val = in_buf[0];
|
|
DRM_DEBUG("val = 0x%02x\n", *val);
|
|
} else {
|
|
DRM_DEBUG("i2c 0x%02x 0x%02x read failed\n",
|
|
addr, *val);
|
|
}
|
|
}
|
|
|
|
void radeon_i2c_put_byte(struct radeon_i2c_chan *i2c_bus,
|
|
u8 slave_addr,
|
|
u8 addr,
|
|
u8 val)
|
|
{
|
|
uint8_t out_buf[2];
|
|
struct iic_msg msg = {
|
|
.slave = slave_addr << 1,
|
|
.flags = 0,
|
|
.len = 2,
|
|
.buf = out_buf,
|
|
};
|
|
|
|
out_buf[0] = addr;
|
|
out_buf[1] = val;
|
|
|
|
if (iicbus_transfer(i2c_bus->adapter, &msg, 1) != 0)
|
|
DRM_DEBUG("i2c 0x%02x 0x%02x write failed\n",
|
|
addr, val);
|
|
}
|
|
|
|
/* ddc router switching */
|
|
void radeon_router_select_ddc_port(struct radeon_connector *radeon_connector)
|
|
{
|
|
u8 val;
|
|
|
|
if (!radeon_connector->router.ddc_valid)
|
|
return;
|
|
|
|
if (!radeon_connector->router_bus)
|
|
return;
|
|
|
|
radeon_i2c_get_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x3, &val);
|
|
val &= ~radeon_connector->router.ddc_mux_control_pin;
|
|
radeon_i2c_put_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x3, val);
|
|
radeon_i2c_get_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x1, &val);
|
|
val &= ~radeon_connector->router.ddc_mux_control_pin;
|
|
val |= radeon_connector->router.ddc_mux_state;
|
|
radeon_i2c_put_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x1, val);
|
|
}
|
|
|
|
/* clock/data router switching */
|
|
void radeon_router_select_cd_port(struct radeon_connector *radeon_connector)
|
|
{
|
|
u8 val;
|
|
|
|
if (!radeon_connector->router.cd_valid)
|
|
return;
|
|
|
|
if (!radeon_connector->router_bus)
|
|
return;
|
|
|
|
radeon_i2c_get_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x3, &val);
|
|
val &= ~radeon_connector->router.cd_mux_control_pin;
|
|
radeon_i2c_put_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x3, val);
|
|
radeon_i2c_get_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x1, &val);
|
|
val &= ~radeon_connector->router.cd_mux_control_pin;
|
|
val |= radeon_connector->router.cd_mux_state;
|
|
radeon_i2c_put_byte(radeon_connector->router_bus,
|
|
radeon_connector->router.i2c_addr,
|
|
0x1, val);
|
|
}
|
|
|