Home | History | Annotate | Line # | Download | only in amdgpu
      1  1.6  riastrad /*	$NetBSD: amdgpu_i2c.c,v 1.6 2021/12/18 23:44:58 riastradh Exp $	*/
      2  1.1  riastrad 
      3  1.1  riastrad /*
      4  1.1  riastrad  * Copyright 2007-8 Advanced Micro Devices, Inc.
      5  1.1  riastrad  * Copyright 2008 Red Hat Inc.
      6  1.1  riastrad  *
      7  1.1  riastrad  * Permission is hereby granted, free of charge, to any person obtaining a
      8  1.1  riastrad  * copy of this software and associated documentation files (the "Software"),
      9  1.1  riastrad  * to deal in the Software without restriction, including without limitation
     10  1.1  riastrad  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
     11  1.1  riastrad  * and/or sell copies of the Software, and to permit persons to whom the
     12  1.1  riastrad  * Software is furnished to do so, subject to the following conditions:
     13  1.1  riastrad  *
     14  1.1  riastrad  * The above copyright notice and this permission notice shall be included in
     15  1.1  riastrad  * all copies or substantial portions of the Software.
     16  1.1  riastrad  *
     17  1.1  riastrad  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     18  1.1  riastrad  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     19  1.1  riastrad  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
     20  1.1  riastrad  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
     21  1.1  riastrad  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
     22  1.1  riastrad  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
     23  1.1  riastrad  * OTHER DEALINGS IN THE SOFTWARE.
     24  1.1  riastrad  *
     25  1.1  riastrad  * Authors: Dave Airlie
     26  1.1  riastrad  *          Alex Deucher
     27  1.1  riastrad  */
     28  1.6  riastrad 
     29  1.1  riastrad #include <sys/cdefs.h>
     30  1.6  riastrad __KERNEL_RCSID(0, "$NetBSD: amdgpu_i2c.c,v 1.6 2021/12/18 23:44:58 riastradh Exp $");
     31  1.1  riastrad 
     32  1.1  riastrad #include <linux/export.h>
     33  1.6  riastrad #include <linux/pci.h>
     34  1.1  riastrad 
     35  1.1  riastrad #include <drm/drm_edid.h>
     36  1.1  riastrad #include <drm/amdgpu_drm.h>
     37  1.1  riastrad #include "amdgpu.h"
     38  1.1  riastrad #include "amdgpu_i2c.h"
     39  1.1  riastrad #include "amdgpu_atombios.h"
     40  1.1  riastrad #include "atom.h"
     41  1.1  riastrad #include "atombios_dp.h"
     42  1.1  riastrad #include "atombios_i2c.h"
     43  1.1  riastrad 
     44  1.4  riastrad #include <linux/nbsd-namespace.h>
     45  1.4  riastrad 
     46  1.1  riastrad /* bit banging i2c */
     47  1.1  riastrad static int amdgpu_i2c_pre_xfer(struct i2c_adapter *i2c_adap)
     48  1.1  riastrad {
     49  1.1  riastrad 	struct amdgpu_i2c_chan *i2c = i2c_get_adapdata(i2c_adap);
     50  1.1  riastrad 	struct amdgpu_device *adev = i2c->dev->dev_private;
     51  1.1  riastrad 	struct amdgpu_i2c_bus_rec *rec = &i2c->rec;
     52  1.1  riastrad 	uint32_t temp;
     53  1.1  riastrad 
     54  1.1  riastrad 	mutex_lock(&i2c->mutex);
     55  1.1  riastrad 
     56  1.1  riastrad 	/* switch the pads to ddc mode */
     57  1.1  riastrad 	if (rec->hw_capable) {
     58  1.1  riastrad 		temp = RREG32(rec->mask_clk_reg);
     59  1.1  riastrad 		temp &= ~(1 << 16);
     60  1.1  riastrad 		WREG32(rec->mask_clk_reg, temp);
     61  1.1  riastrad 	}
     62  1.1  riastrad 
     63  1.1  riastrad 	/* clear the output pin values */
     64  1.1  riastrad 	temp = RREG32(rec->a_clk_reg) & ~rec->a_clk_mask;
     65  1.1  riastrad 	WREG32(rec->a_clk_reg, temp);
     66  1.1  riastrad 
     67  1.1  riastrad 	temp = RREG32(rec->a_data_reg) & ~rec->a_data_mask;
     68  1.1  riastrad 	WREG32(rec->a_data_reg, temp);
     69  1.1  riastrad 
     70  1.1  riastrad 	/* set the pins to input */
     71  1.1  riastrad 	temp = RREG32(rec->en_clk_reg) & ~rec->en_clk_mask;
     72  1.1  riastrad 	WREG32(rec->en_clk_reg, temp);
     73  1.1  riastrad 
     74  1.1  riastrad 	temp = RREG32(rec->en_data_reg) & ~rec->en_data_mask;
     75  1.1  riastrad 	WREG32(rec->en_data_reg, temp);
     76  1.1  riastrad 
     77  1.1  riastrad 	/* mask the gpio pins for software use */
     78  1.1  riastrad 	temp = RREG32(rec->mask_clk_reg) | rec->mask_clk_mask;
     79  1.1  riastrad 	WREG32(rec->mask_clk_reg, temp);
     80  1.1  riastrad 	temp = RREG32(rec->mask_clk_reg);
     81  1.1  riastrad 
     82  1.1  riastrad 	temp = RREG32(rec->mask_data_reg) | rec->mask_data_mask;
     83  1.1  riastrad 	WREG32(rec->mask_data_reg, temp);
     84  1.1  riastrad 	temp = RREG32(rec->mask_data_reg);
     85  1.1  riastrad 
     86  1.1  riastrad 	return 0;
     87  1.1  riastrad }
     88  1.1  riastrad 
     89  1.1  riastrad static void amdgpu_i2c_post_xfer(struct i2c_adapter *i2c_adap)
     90  1.1  riastrad {
     91  1.1  riastrad 	struct amdgpu_i2c_chan *i2c = i2c_get_adapdata(i2c_adap);
     92  1.1  riastrad 	struct amdgpu_device *adev = i2c->dev->dev_private;
     93  1.1  riastrad 	struct amdgpu_i2c_bus_rec *rec = &i2c->rec;
     94  1.1  riastrad 	uint32_t temp;
     95  1.1  riastrad 
     96  1.1  riastrad 	/* unmask the gpio pins for software use */
     97  1.1  riastrad 	temp = RREG32(rec->mask_clk_reg) & ~rec->mask_clk_mask;
     98  1.1  riastrad 	WREG32(rec->mask_clk_reg, temp);
     99  1.1  riastrad 	temp = RREG32(rec->mask_clk_reg);
    100  1.1  riastrad 
    101  1.1  riastrad 	temp = RREG32(rec->mask_data_reg) & ~rec->mask_data_mask;
    102  1.1  riastrad 	WREG32(rec->mask_data_reg, temp);
    103  1.1  riastrad 	temp = RREG32(rec->mask_data_reg);
    104  1.1  riastrad 
    105  1.1  riastrad 	mutex_unlock(&i2c->mutex);
    106  1.1  riastrad }
    107  1.1  riastrad 
    108  1.1  riastrad static int amdgpu_i2c_get_clock(void *i2c_priv)
    109  1.1  riastrad {
    110  1.1  riastrad 	struct amdgpu_i2c_chan *i2c = i2c_priv;
    111  1.1  riastrad 	struct amdgpu_device *adev = i2c->dev->dev_private;
    112  1.1  riastrad 	struct amdgpu_i2c_bus_rec *rec = &i2c->rec;
    113  1.1  riastrad 	uint32_t val;
    114  1.1  riastrad 
    115  1.1  riastrad 	/* read the value off the pin */
    116  1.1  riastrad 	val = RREG32(rec->y_clk_reg);
    117  1.1  riastrad 	val &= rec->y_clk_mask;
    118  1.1  riastrad 
    119  1.1  riastrad 	return (val != 0);
    120  1.1  riastrad }
    121  1.1  riastrad 
    122  1.1  riastrad 
    123  1.1  riastrad static int amdgpu_i2c_get_data(void *i2c_priv)
    124  1.1  riastrad {
    125  1.1  riastrad 	struct amdgpu_i2c_chan *i2c = i2c_priv;
    126  1.1  riastrad 	struct amdgpu_device *adev = i2c->dev->dev_private;
    127  1.1  riastrad 	struct amdgpu_i2c_bus_rec *rec = &i2c->rec;
    128  1.1  riastrad 	uint32_t val;
    129  1.1  riastrad 
    130  1.1  riastrad 	/* read the value off the pin */
    131  1.1  riastrad 	val = RREG32(rec->y_data_reg);
    132  1.1  riastrad 	val &= rec->y_data_mask;
    133  1.1  riastrad 
    134  1.1  riastrad 	return (val != 0);
    135  1.1  riastrad }
    136  1.1  riastrad 
    137  1.1  riastrad static void amdgpu_i2c_set_clock(void *i2c_priv, int clock)
    138  1.1  riastrad {
    139  1.1  riastrad 	struct amdgpu_i2c_chan *i2c = i2c_priv;
    140  1.1  riastrad 	struct amdgpu_device *adev = i2c->dev->dev_private;
    141  1.1  riastrad 	struct amdgpu_i2c_bus_rec *rec = &i2c->rec;
    142  1.1  riastrad 	uint32_t val;
    143  1.1  riastrad 
    144  1.1  riastrad 	/* set pin direction */
    145  1.1  riastrad 	val = RREG32(rec->en_clk_reg) & ~rec->en_clk_mask;
    146  1.1  riastrad 	val |= clock ? 0 : rec->en_clk_mask;
    147  1.1  riastrad 	WREG32(rec->en_clk_reg, val);
    148  1.1  riastrad }
    149  1.1  riastrad 
    150  1.1  riastrad static void amdgpu_i2c_set_data(void *i2c_priv, int data)
    151  1.1  riastrad {
    152  1.1  riastrad 	struct amdgpu_i2c_chan *i2c = i2c_priv;
    153  1.1  riastrad 	struct amdgpu_device *adev = i2c->dev->dev_private;
    154  1.1  riastrad 	struct amdgpu_i2c_bus_rec *rec = &i2c->rec;
    155  1.1  riastrad 	uint32_t val;
    156  1.1  riastrad 
    157  1.1  riastrad 	/* set pin direction */
    158  1.1  riastrad 	val = RREG32(rec->en_data_reg) & ~rec->en_data_mask;
    159  1.1  riastrad 	val |= data ? 0 : rec->en_data_mask;
    160  1.1  riastrad 	WREG32(rec->en_data_reg, val);
    161  1.1  riastrad }
    162  1.1  riastrad 
    163  1.1  riastrad static const struct i2c_algorithm amdgpu_atombios_i2c_algo = {
    164  1.1  riastrad 	.master_xfer = amdgpu_atombios_i2c_xfer,
    165  1.1  riastrad 	.functionality = amdgpu_atombios_i2c_func,
    166  1.1  riastrad };
    167  1.1  riastrad 
    168  1.1  riastrad struct amdgpu_i2c_chan *amdgpu_i2c_create(struct drm_device *dev,
    169  1.6  riastrad 					  const struct amdgpu_i2c_bus_rec *rec,
    170  1.6  riastrad 					  const char *name)
    171  1.1  riastrad {
    172  1.1  riastrad 	struct amdgpu_i2c_chan *i2c;
    173  1.1  riastrad 	int ret;
    174  1.1  riastrad 
    175  1.1  riastrad 	/* don't add the mm_i2c bus unless hw_i2c is enabled */
    176  1.1  riastrad 	if (rec->mm_i2c && (amdgpu_hw_i2c == 0))
    177  1.1  riastrad 		return NULL;
    178  1.1  riastrad 
    179  1.1  riastrad 	i2c = kzalloc(sizeof(struct amdgpu_i2c_chan), GFP_KERNEL);
    180  1.1  riastrad 	if (i2c == NULL)
    181  1.1  riastrad 		return NULL;
    182  1.1  riastrad 
    183  1.1  riastrad 	i2c->rec = *rec;
    184  1.1  riastrad 	i2c->adapter.owner = THIS_MODULE;
    185  1.1  riastrad 	i2c->adapter.class = I2C_CLASS_DDC;
    186  1.3  riastrad 	i2c->adapter.dev.parent = dev->dev;
    187  1.1  riastrad 	i2c->dev = dev;
    188  1.1  riastrad 	i2c_set_adapdata(&i2c->adapter, i2c);
    189  1.1  riastrad 	mutex_init(&i2c->mutex);
    190  1.1  riastrad 	if (rec->hw_capable &&
    191  1.1  riastrad 	    amdgpu_hw_i2c) {
    192  1.1  riastrad 		/* hw i2c using atom */
    193  1.1  riastrad 		snprintf(i2c->adapter.name, sizeof(i2c->adapter.name),
    194  1.1  riastrad 			 "AMDGPU i2c hw bus %s", name);
    195  1.1  riastrad 		i2c->adapter.algo = &amdgpu_atombios_i2c_algo;
    196  1.1  riastrad 		ret = i2c_add_adapter(&i2c->adapter);
    197  1.6  riastrad 		if (ret)
    198  1.1  riastrad 			goto out_free;
    199  1.1  riastrad 	} else {
    200  1.1  riastrad 		/* set the amdgpu bit adapter */
    201  1.1  riastrad 		snprintf(i2c->adapter.name, sizeof(i2c->adapter.name),
    202  1.1  riastrad 			 "AMDGPU i2c bit bus %s", name);
    203  1.1  riastrad 		i2c->adapter.algo_data = &i2c->bit;
    204  1.1  riastrad 		i2c->bit.pre_xfer = amdgpu_i2c_pre_xfer;
    205  1.1  riastrad 		i2c->bit.post_xfer = amdgpu_i2c_post_xfer;
    206  1.1  riastrad 		i2c->bit.setsda = amdgpu_i2c_set_data;
    207  1.1  riastrad 		i2c->bit.setscl = amdgpu_i2c_set_clock;
    208  1.1  riastrad 		i2c->bit.getsda = amdgpu_i2c_get_data;
    209  1.1  riastrad 		i2c->bit.getscl = amdgpu_i2c_get_clock;
    210  1.1  riastrad 		i2c->bit.udelay = 10;
    211  1.1  riastrad 		i2c->bit.timeout = usecs_to_jiffies(2200);	/* from VESA */
    212  1.1  riastrad 		i2c->bit.data = i2c;
    213  1.1  riastrad 		ret = i2c_bit_add_bus(&i2c->adapter);
    214  1.1  riastrad 		if (ret) {
    215  1.1  riastrad 			DRM_ERROR("Failed to register bit i2c %s\n", name);
    216  1.1  riastrad 			goto out_free;
    217  1.1  riastrad 		}
    218  1.1  riastrad 	}
    219  1.1  riastrad 
    220  1.1  riastrad 	return i2c;
    221  1.1  riastrad out_free:
    222  1.3  riastrad 	mutex_destroy(&i2c->mutex);
    223  1.1  riastrad 	kfree(i2c);
    224  1.1  riastrad 	return NULL;
    225  1.1  riastrad 
    226  1.1  riastrad }
    227  1.1  riastrad 
    228  1.1  riastrad void amdgpu_i2c_destroy(struct amdgpu_i2c_chan *i2c)
    229  1.1  riastrad {
    230  1.1  riastrad 	if (!i2c)
    231  1.1  riastrad 		return;
    232  1.6  riastrad 	WARN_ON(i2c->has_aux);
    233  1.1  riastrad 	i2c_del_adapter(&i2c->adapter);
    234  1.3  riastrad 	mutex_destroy(&i2c->mutex);
    235  1.1  riastrad 	kfree(i2c);
    236  1.1  riastrad }
    237  1.1  riastrad 
    238  1.1  riastrad /* Add the default buses */
    239  1.1  riastrad void amdgpu_i2c_init(struct amdgpu_device *adev)
    240  1.1  riastrad {
    241  1.1  riastrad 	if (amdgpu_hw_i2c)
    242  1.1  riastrad 		DRM_INFO("hw_i2c forced on, you may experience display detection problems!\n");
    243  1.1  riastrad 
    244  1.6  riastrad 	amdgpu_atombios_i2c_init(adev);
    245  1.1  riastrad }
    246  1.1  riastrad 
    247  1.1  riastrad /* remove all the buses */
    248  1.1  riastrad void amdgpu_i2c_fini(struct amdgpu_device *adev)
    249  1.1  riastrad {
    250  1.1  riastrad 	int i;
    251  1.1  riastrad 
    252  1.1  riastrad 	for (i = 0; i < AMDGPU_MAX_I2C_BUS; i++) {
    253  1.1  riastrad 		if (adev->i2c_bus[i]) {
    254  1.1  riastrad 			amdgpu_i2c_destroy(adev->i2c_bus[i]);
    255  1.1  riastrad 			adev->i2c_bus[i] = NULL;
    256  1.1  riastrad 		}
    257  1.1  riastrad 	}
    258  1.1  riastrad }
    259  1.1  riastrad 
    260  1.1  riastrad /* Add additional buses */
    261  1.1  riastrad void amdgpu_i2c_add(struct amdgpu_device *adev,
    262  1.6  riastrad 		    const struct amdgpu_i2c_bus_rec *rec,
    263  1.6  riastrad 		    const char *name)
    264  1.1  riastrad {
    265  1.1  riastrad 	struct drm_device *dev = adev->ddev;
    266  1.1  riastrad 	int i;
    267  1.1  riastrad 
    268  1.1  riastrad 	for (i = 0; i < AMDGPU_MAX_I2C_BUS; i++) {
    269  1.1  riastrad 		if (!adev->i2c_bus[i]) {
    270  1.1  riastrad 			adev->i2c_bus[i] = amdgpu_i2c_create(dev, rec, name);
    271  1.1  riastrad 			return;
    272  1.1  riastrad 		}
    273  1.1  riastrad 	}
    274  1.1  riastrad }
    275  1.1  riastrad 
    276  1.1  riastrad /* looks up bus based on id */
    277  1.1  riastrad struct amdgpu_i2c_chan *
    278  1.1  riastrad amdgpu_i2c_lookup(struct amdgpu_device *adev,
    279  1.6  riastrad 		  const struct amdgpu_i2c_bus_rec *i2c_bus)
    280  1.1  riastrad {
    281  1.1  riastrad 	int i;
    282  1.1  riastrad 
    283  1.1  riastrad 	for (i = 0; i < AMDGPU_MAX_I2C_BUS; i++) {
    284  1.1  riastrad 		if (adev->i2c_bus[i] &&
    285  1.1  riastrad 		    (adev->i2c_bus[i]->rec.i2c_id == i2c_bus->i2c_id)) {
    286  1.1  riastrad 			return adev->i2c_bus[i];
    287  1.1  riastrad 		}
    288  1.1  riastrad 	}
    289  1.1  riastrad 	return NULL;
    290  1.1  riastrad }
    291  1.1  riastrad 
    292  1.1  riastrad static void amdgpu_i2c_get_byte(struct amdgpu_i2c_chan *i2c_bus,
    293  1.1  riastrad 				 u8 slave_addr,
    294  1.1  riastrad 				 u8 addr,
    295  1.1  riastrad 				 u8 *val)
    296  1.1  riastrad {
    297  1.1  riastrad 	u8 out_buf[2];
    298  1.1  riastrad 	u8 in_buf[2];
    299  1.1  riastrad 	struct i2c_msg msgs[] = {
    300  1.1  riastrad 		{
    301  1.1  riastrad 			.addr = slave_addr,
    302  1.1  riastrad 			.flags = 0,
    303  1.1  riastrad 			.len = 1,
    304  1.1  riastrad 			.buf = out_buf,
    305  1.1  riastrad 		},
    306  1.1  riastrad 		{
    307  1.1  riastrad 			.addr = slave_addr,
    308  1.1  riastrad 			.flags = I2C_M_RD,
    309  1.1  riastrad 			.len = 1,
    310  1.1  riastrad 			.buf = in_buf,
    311  1.1  riastrad 		}
    312  1.1  riastrad 	};
    313  1.1  riastrad 
    314  1.1  riastrad 	out_buf[0] = addr;
    315  1.1  riastrad 	out_buf[1] = 0;
    316  1.1  riastrad 
    317  1.1  riastrad 	if (i2c_transfer(&i2c_bus->adapter, msgs, 2) == 2) {
    318  1.1  riastrad 		*val = in_buf[0];
    319  1.1  riastrad 		DRM_DEBUG("val = 0x%02x\n", *val);
    320  1.1  riastrad 	} else {
    321  1.1  riastrad 		DRM_DEBUG("i2c 0x%02x 0x%02x read failed\n",
    322  1.1  riastrad 			  addr, *val);
    323  1.1  riastrad 	}
    324  1.1  riastrad }
    325  1.1  riastrad 
    326  1.1  riastrad static void amdgpu_i2c_put_byte(struct amdgpu_i2c_chan *i2c_bus,
    327  1.1  riastrad 				 u8 slave_addr,
    328  1.1  riastrad 				 u8 addr,
    329  1.1  riastrad 				 u8 val)
    330  1.1  riastrad {
    331  1.1  riastrad 	uint8_t out_buf[2];
    332  1.1  riastrad 	struct i2c_msg msg = {
    333  1.1  riastrad 		.addr = slave_addr,
    334  1.1  riastrad 		.flags = 0,
    335  1.1  riastrad 		.len = 2,
    336  1.1  riastrad 		.buf = out_buf,
    337  1.1  riastrad 	};
    338  1.1  riastrad 
    339  1.1  riastrad 	out_buf[0] = addr;
    340  1.1  riastrad 	out_buf[1] = val;
    341  1.1  riastrad 
    342  1.1  riastrad 	if (i2c_transfer(&i2c_bus->adapter, &msg, 1) != 1)
    343  1.1  riastrad 		DRM_DEBUG("i2c 0x%02x 0x%02x write failed\n",
    344  1.1  riastrad 			  addr, val);
    345  1.1  riastrad }
    346  1.1  riastrad 
    347  1.1  riastrad /* ddc router switching */
    348  1.1  riastrad void
    349  1.6  riastrad amdgpu_i2c_router_select_ddc_port(const struct amdgpu_connector *amdgpu_connector)
    350  1.1  riastrad {
    351  1.1  riastrad 	u8 val;
    352  1.1  riastrad 
    353  1.1  riastrad 	if (!amdgpu_connector->router.ddc_valid)
    354  1.1  riastrad 		return;
    355  1.1  riastrad 
    356  1.1  riastrad 	if (!amdgpu_connector->router_bus)
    357  1.1  riastrad 		return;
    358  1.1  riastrad 
    359  1.1  riastrad 	amdgpu_i2c_get_byte(amdgpu_connector->router_bus,
    360  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    361  1.1  riastrad 			    0x3, &val);
    362  1.1  riastrad 	val &= ~amdgpu_connector->router.ddc_mux_control_pin;
    363  1.1  riastrad 	amdgpu_i2c_put_byte(amdgpu_connector->router_bus,
    364  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    365  1.1  riastrad 			    0x3, val);
    366  1.1  riastrad 	amdgpu_i2c_get_byte(amdgpu_connector->router_bus,
    367  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    368  1.1  riastrad 			    0x1, &val);
    369  1.1  riastrad 	val &= ~amdgpu_connector->router.ddc_mux_control_pin;
    370  1.1  riastrad 	val |= amdgpu_connector->router.ddc_mux_state;
    371  1.1  riastrad 	amdgpu_i2c_put_byte(amdgpu_connector->router_bus,
    372  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    373  1.1  riastrad 			    0x1, val);
    374  1.1  riastrad }
    375  1.1  riastrad 
    376  1.1  riastrad /* clock/data router switching */
    377  1.1  riastrad void
    378  1.6  riastrad amdgpu_i2c_router_select_cd_port(const struct amdgpu_connector *amdgpu_connector)
    379  1.1  riastrad {
    380  1.1  riastrad 	u8 val;
    381  1.1  riastrad 
    382  1.1  riastrad 	if (!amdgpu_connector->router.cd_valid)
    383  1.1  riastrad 		return;
    384  1.1  riastrad 
    385  1.1  riastrad 	if (!amdgpu_connector->router_bus)
    386  1.1  riastrad 		return;
    387  1.1  riastrad 
    388  1.1  riastrad 	amdgpu_i2c_get_byte(amdgpu_connector->router_bus,
    389  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    390  1.1  riastrad 			    0x3, &val);
    391  1.1  riastrad 	val &= ~amdgpu_connector->router.cd_mux_control_pin;
    392  1.1  riastrad 	amdgpu_i2c_put_byte(amdgpu_connector->router_bus,
    393  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    394  1.1  riastrad 			    0x3, val);
    395  1.1  riastrad 	amdgpu_i2c_get_byte(amdgpu_connector->router_bus,
    396  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    397  1.1  riastrad 			    0x1, &val);
    398  1.1  riastrad 	val &= ~amdgpu_connector->router.cd_mux_control_pin;
    399  1.1  riastrad 	val |= amdgpu_connector->router.cd_mux_state;
    400  1.1  riastrad 	amdgpu_i2c_put_byte(amdgpu_connector->router_bus,
    401  1.1  riastrad 			    amdgpu_connector->router.i2c_addr,
    402  1.1  riastrad 			    0x1, val);
    403  1.1  riastrad }
    404