[mirror_ubuntu-bionic-kernel.git] / drivers / video / fbdev / aty / radeon_i2c.c

// SPDX-License-Identifier: GPL-2.0
#include "radeonfb.h"

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/fb.h>


#include <linux/i2c.h>
#include <linux/i2c-algo-bit.h>

#include <asm/io.h>

#include <video/radeon.h>
#include "../edid.h"

static void radeon_gpio_setscl(void* data, int state)
{
	struct radeon_i2c_chan 	*chan = data;
	struct radeonfb_info	*rinfo = chan->rinfo;
	u32			val;
	
	val = INREG(chan->ddc_reg) & ~(VGA_DDC_CLK_OUT_EN);
	if (!state)
		val |= VGA_DDC_CLK_OUT_EN;

	OUTREG(chan->ddc_reg, val);
	(void)INREG(chan->ddc_reg);
}

static void radeon_gpio_setsda(void* data, int state)
{
	struct radeon_i2c_chan 	*chan = data;
	struct radeonfb_info	*rinfo = chan->rinfo;
	u32			val;
	
	val = INREG(chan->ddc_reg) & ~(VGA_DDC_DATA_OUT_EN);
	if (!state)
		val |= VGA_DDC_DATA_OUT_EN;

	OUTREG(chan->ddc_reg, val);
	(void)INREG(chan->ddc_reg);
}

static int radeon_gpio_getscl(void* data)
{
	struct radeon_i2c_chan 	*chan = data;
	struct radeonfb_info	*rinfo = chan->rinfo;
	u32			val;
	
	val = INREG(chan->ddc_reg);

	return (val & VGA_DDC_CLK_INPUT) ? 1 : 0;
}

static int radeon_gpio_getsda(void* data)
{
	struct radeon_i2c_chan 	*chan = data;
	struct radeonfb_info	*rinfo = chan->rinfo;
	u32			val;
	
	val = INREG(chan->ddc_reg);

	return (val & VGA_DDC_DATA_INPUT) ? 1 : 0;
}

static int radeon_setup_i2c_bus(struct radeon_i2c_chan *chan, const char *name)
{
	int rc;

	snprintf(chan->adapter.name, sizeof(chan->adapter.name),
		 "radeonfb %s", name);
	chan->adapter.owner		= THIS_MODULE;
	chan->adapter.algo_data		= &chan->algo;
	chan->adapter.dev.parent	= &chan->rinfo->pdev->dev;
	chan->algo.setsda		= radeon_gpio_setsda;
	chan->algo.setscl		= radeon_gpio_setscl;
	chan->algo.getsda		= radeon_gpio_getsda;
	chan->algo.getscl		= radeon_gpio_getscl;
	chan->algo.udelay		= 10;
	chan->algo.timeout		= 20;
	chan->algo.data 		= chan;	
	
	i2c_set_adapdata(&chan->adapter, chan);
	
	/* Raise SCL and SDA */
	radeon_gpio_setsda(chan, 1);
	radeon_gpio_setscl(chan, 1);
	udelay(20);

	rc = i2c_bit_add_bus(&chan->adapter);
	if (rc == 0)
		dev_dbg(&chan->rinfo->pdev->dev, "I2C bus %s registered.\n", name);
	else
		dev_warn(&chan->rinfo->pdev->dev, "Failed to register I2C bus %s.\n", name);
	return rc;
}

void radeon_create_i2c_busses(struct radeonfb_info *rinfo)
{
	rinfo->i2c[0].rinfo	= rinfo;
	rinfo->i2c[0].ddc_reg	= GPIO_MONID;
#ifndef CONFIG_PPC
	rinfo->i2c[0].adapter.class = I2C_CLASS_HWMON;
#endif
	radeon_setup_i2c_bus(&rinfo->i2c[0], "monid");

	rinfo->i2c[1].rinfo	= rinfo;
	rinfo->i2c[1].ddc_reg	= GPIO_DVI_DDC;
	radeon_setup_i2c_bus(&rinfo->i2c[1], "dvi");

	rinfo->i2c[2].rinfo	= rinfo;
	rinfo->i2c[2].ddc_reg	= GPIO_VGA_DDC;
	radeon_setup_i2c_bus(&rinfo->i2c[2], "vga");

	rinfo->i2c[3].rinfo	= rinfo;
	rinfo->i2c[3].ddc_reg	= GPIO_CRT2_DDC;
	radeon_setup_i2c_bus(&rinfo->i2c[3], "crt2");
}

void radeon_delete_i2c_busses(struct radeonfb_info *rinfo)
{
	if (rinfo->i2c[0].rinfo)
		i2c_del_adapter(&rinfo->i2c[0].adapter);
	rinfo->i2c[0].rinfo = NULL;

	if (rinfo->i2c[1].rinfo)
		i2c_del_adapter(&rinfo->i2c[1].adapter);
	rinfo->i2c[1].rinfo = NULL;

	if (rinfo->i2c[2].rinfo)
		i2c_del_adapter(&rinfo->i2c[2].adapter);
	rinfo->i2c[2].rinfo = NULL;

	if (rinfo->i2c[3].rinfo)
		i2c_del_adapter(&rinfo->i2c[3].adapter);
	rinfo->i2c[3].rinfo = NULL;
}

int radeon_probe_i2c_connector(struct radeonfb_info *rinfo, int conn,
			       u8 **out_edid)
{
	u8 *edid;

	edid = fb_ddc_read(&rinfo->i2c[conn-1].adapter);

	if (out_edid)
		*out_edid = edid;
	if (!edid) {
		pr_debug("radeonfb: I2C (port %d) ... not found\n", conn);
		return MT_NONE;
	}
	if (edid[0x14] & 0x80) {
		/* Fix detection using BIOS tables */
		if (rinfo->is_mobility /*&& conn == ddc_dvi*/ &&
		    (INREG(LVDS_GEN_CNTL) & LVDS_ON)) {
			pr_debug("radeonfb: I2C (port %d) ... found LVDS panel\n", conn);
			return MT_LCD;
		} else {
			pr_debug("radeonfb: I2C (port %d) ... found TMDS panel\n", conn);
			return MT_DFP;
		}
	}
	pr_debug("radeonfb: I2C (port %d) ... found CRT display\n", conn);
	return MT_CRT;
}
Commit	Line	Data
b2441318	1	// SPDX-License-Identifier: GPL-2.0
b0313f89 JD	2	#include "radeonfb.h"
b0313f89 JD	3
1da177e4 LT	4	#include <linux/module.h>
1da177e4 LT	5	#include <linux/kernel.h>
1da177e4	6	#include <linux/delay.h>
1da177e4 LT	7	#include <linux/fb.h>
	8
	9
	10	#include <linux/i2c.h>
1da177e4 LT	11	#include <linux/i2c-algo-bit.h>
	12
	13	#include <asm/io.h>
	14
	15	#include <video/radeon.h>
1da177e4 LT	16	#include "../edid.h"
1da177e4 LT	17
1da177e4 LT	18	static void radeon_gpio_setscl(void* data, int state)
	19	{
	20	struct radeon_i2c_chan *chan = data;
	21	struct radeonfb_info *rinfo = chan->rinfo;
	22	u32 val;
	23
	24	val = INREG(chan->ddc_reg) & ~(VGA_DDC_CLK_OUT_EN);
	25	if (!state)
	26	val \|= VGA_DDC_CLK_OUT_EN;
	27
	28	OUTREG(chan->ddc_reg, val);
	29	(void)INREG(chan->ddc_reg);
	30	}
	31
	32	static void radeon_gpio_setsda(void* data, int state)
	33	{
	34	struct radeon_i2c_chan *chan = data;
	35	struct radeonfb_info *rinfo = chan->rinfo;
	36	u32 val;
	37
	38	val = INREG(chan->ddc_reg) & ~(VGA_DDC_DATA_OUT_EN);
	39	if (!state)
	40	val \|= VGA_DDC_DATA_OUT_EN;
	41
	42	OUTREG(chan->ddc_reg, val);
	43	(void)INREG(chan->ddc_reg);
	44	}
	45
	46	static int radeon_gpio_getscl(void* data)
	47	{
	48	struct radeon_i2c_chan *chan = data;
	49	struct radeonfb_info *rinfo = chan->rinfo;
	50	u32 val;
	51
	52	val = INREG(chan->ddc_reg);
	53
	54	return (val & VGA_DDC_CLK_INPUT) ? 1 : 0;
	55	}
	56
	57	static int radeon_gpio_getsda(void* data)
	58	{
	59	struct radeon_i2c_chan *chan = data;
	60	struct radeonfb_info *rinfo = chan->rinfo;
	61	u32 val;
	62
	63	val = INREG(chan->ddc_reg);
	64
	65	return (val & VGA_DDC_DATA_INPUT) ? 1 : 0;
	66	}
	67
	68	static int radeon_setup_i2c_bus(struct radeon_i2c_chan chan, const char name)
	69	{
	70	int rc;
	71
9bd6ceb6 JD	72	snprintf(chan->adapter.name, sizeof(chan->adapter.name),
9bd6ceb6 JD	73	"radeonfb %s", name);
1da177e4	74	chan->adapter.owner = THIS_MODULE;
1da177e4 LT	75	chan->adapter.algo_data = &chan->algo;
	76	chan->adapter.dev.parent = &chan->rinfo->pdev->dev;
	77	chan->algo.setsda = radeon_gpio_setsda;
	78	chan->algo.setscl = radeon_gpio_setscl;
	79	chan->algo.getsda = radeon_gpio_getsda;
	80	chan->algo.getscl = radeon_gpio_getscl;
e0745ae7	81	chan->algo.udelay = 10;
1da177e4 LT	82	chan->algo.timeout = 20;
	83	chan->algo.data = chan;
	84
	85	i2c_set_adapdata(&chan->adapter, chan);
	86
	87	/* Raise SCL and SDA */
	88	radeon_gpio_setsda(chan, 1);
	89	radeon_gpio_setscl(chan, 1);
	90	udelay(20);
	91
	92	rc = i2c_bit_add_bus(&chan->adapter);
	93	if (rc == 0)
	94	dev_dbg(&chan->rinfo->pdev->dev, "I2C bus %s registered.\n", name);
	95	else
	96	dev_warn(&chan->rinfo->pdev->dev, "Failed to register I2C bus %s.\n", name);
	97	return rc;
	98	}
	99
	100	void radeon_create_i2c_busses(struct radeonfb_info *rinfo)
	101	{
	102	rinfo->i2c[0].rinfo = rinfo;
	103	rinfo->i2c[0].ddc_reg = GPIO_MONID;
49bb0943 JD	104	#ifndef CONFIG_PPC
	105	rinfo->i2c[0].adapter.class = I2C_CLASS_HWMON;
	106	#endif
1da177e4 LT	107	radeon_setup_i2c_bus(&rinfo->i2c[0], "monid");
	108
	109	rinfo->i2c[1].rinfo = rinfo;
	110	rinfo->i2c[1].ddc_reg = GPIO_DVI_DDC;
	111	radeon_setup_i2c_bus(&rinfo->i2c[1], "dvi");
	112
	113	rinfo->i2c[2].rinfo = rinfo;
	114	rinfo->i2c[2].ddc_reg = GPIO_VGA_DDC;
	115	radeon_setup_i2c_bus(&rinfo->i2c[2], "vga");
	116
	117	rinfo->i2c[3].rinfo = rinfo;
	118	rinfo->i2c[3].ddc_reg = GPIO_CRT2_DDC;
	119	radeon_setup_i2c_bus(&rinfo->i2c[3], "crt2");
	120	}
	121
	122	void radeon_delete_i2c_busses(struct radeonfb_info *rinfo)
	123	{
	124	if (rinfo->i2c[0].rinfo)
3269711b	125	i2c_del_adapter(&rinfo->i2c[0].adapter);
1da177e4 LT	126	rinfo->i2c[0].rinfo = NULL;
	127
	128	if (rinfo->i2c[1].rinfo)
3269711b	129	i2c_del_adapter(&rinfo->i2c[1].adapter);
1da177e4 LT	130	rinfo->i2c[1].rinfo = NULL;
	131
	132	if (rinfo->i2c[2].rinfo)
3269711b	133	i2c_del_adapter(&rinfo->i2c[2].adapter);
1da177e4 LT	134	rinfo->i2c[2].rinfo = NULL;
	135
	136	if (rinfo->i2c[3].rinfo)
3269711b	137	i2c_del_adapter(&rinfo->i2c[3].adapter);
1da177e4 LT	138	rinfo->i2c[3].rinfo = NULL;
	139	}
	140
7a45093b DM	141	int radeon_probe_i2c_connector(struct radeonfb_info *rinfo, int conn,
7a45093b DM	142	u8 **out_edid)
1da177e4	143	{
4f71c5de BH	144	u8 *edid;
4f71c5de BH	145
4f71c5de	146	edid = fb_ddc_read(&rinfo->i2c[conn-1].adapter);
1da177e4 LT	147
	148	if (out_edid)
	149	*out_edid = edid;
	150	if (!edid) {
bc3bf466	151	pr_debug("radeonfb: I2C (port %d) ... not found\n", conn);
1da177e4 LT	152	return MT_NONE;
	153	}
	154	if (edid[0x14] & 0x80) {
	155	/* Fix detection using BIOS tables */
	156	if (rinfo->is_mobility /&& conn == ddc_dvi/ &&
	157	(INREG(LVDS_GEN_CNTL) & LVDS_ON)) {
bc3bf466	158	pr_debug("radeonfb: I2C (port %d) ... found LVDS panel\n", conn);
1da177e4 LT	159	return MT_LCD;
1da177e4 LT	160	} else {
bc3bf466	161	pr_debug("radeonfb: I2C (port %d) ... found TMDS panel\n", conn);
1da177e4 LT	162	return MT_DFP;
	163	}
	164	}
bc3bf466	165	pr_debug("radeonfb: I2C (port %d) ... found CRT display\n", conn);
1da177e4 LT	166	return MT_CRT;
	167	}
	168