[deliverable/linux.git] / drivers / gpu / drm / i2c / sil164_drv.c

/*
 * Copyright (C) 2010 Francisco Jerez.
 * All Rights Reserved.
 *
 * 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 (including the
 * next paragraph) 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 OWNER(S) AND/OR ITS SUPPLIERS 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.
 *
 */

#include <linux/module.h>

#include <drm/drmP.h>
#include <drm/drm_crtc_helper.h>
#include <drm/drm_encoder_slave.h>
#include <drm/i2c/sil164.h>

struct sil164_priv {
	struct sil164_encoder_params config;
	struct i2c_client *duallink_slave;

	uint8_t saved_state[0x10];
	uint8_t saved_slave_state[0x10];
};

#define to_sil164_priv(x) \
	((struct sil164_priv *)to_encoder_slave(x)->slave_priv)

#define sil164_dbg(client, format, ...) do {				\
		if (drm_debug & DRM_UT_KMS)				\
			dev_printk(KERN_DEBUG, &client->dev,		\
				   "%s: " format, __func__, ## __VA_ARGS__); \
	} while (0)
#define sil164_info(client, format, ...)		\
	dev_info(&client->dev, format, __VA_ARGS__)
#define sil164_err(client, format, ...)			\
	dev_err(&client->dev, format, __VA_ARGS__)

#define SIL164_I2C_ADDR_MASTER			0x38
#define SIL164_I2C_ADDR_SLAVE			0x39

/* HW register definitions */

#define SIL164_VENDOR_LO			0x0
#define SIL164_VENDOR_HI			0x1
#define SIL164_DEVICE_LO			0x2
#define SIL164_DEVICE_HI			0x3
#define SIL164_REVISION				0x4
#define SIL164_FREQ_MIN				0x6
#define SIL164_FREQ_MAX				0x7
#define SIL164_CONTROL0				0x8
#  define SIL164_CONTROL0_POWER_ON		0x01
#  define SIL164_CONTROL0_EDGE_RISING		0x02
#  define SIL164_CONTROL0_INPUT_24BIT		0x04
#  define SIL164_CONTROL0_DUAL_EDGE		0x08
#  define SIL164_CONTROL0_HSYNC_ON		0x10
#  define SIL164_CONTROL0_VSYNC_ON		0x20
#define SIL164_DETECT				0x9
#  define SIL164_DETECT_INTR_STAT		0x01
#  define SIL164_DETECT_HOTPLUG_STAT		0x02
#  define SIL164_DETECT_RECEIVER_STAT		0x04
#  define SIL164_DETECT_INTR_MODE_RECEIVER	0x00
#  define SIL164_DETECT_INTR_MODE_HOTPLUG	0x08
#  define SIL164_DETECT_OUT_MODE_HIGH		0x00
#  define SIL164_DETECT_OUT_MODE_INTR		0x10
#  define SIL164_DETECT_OUT_MODE_RECEIVER	0x20
#  define SIL164_DETECT_OUT_MODE_HOTPLUG	0x30
#  define SIL164_DETECT_VSWING_STAT		0x80
#define SIL164_CONTROL1				0xa
#  define SIL164_CONTROL1_DESKEW_ENABLE		0x10
#  define SIL164_CONTROL1_DESKEW_INCR_SHIFT	5
#define SIL164_GPIO				0xb
#define SIL164_CONTROL2				0xc
#  define SIL164_CONTROL2_FILTER_ENABLE		0x01
#  define SIL164_CONTROL2_FILTER_SETTING_SHIFT	1
#  define SIL164_CONTROL2_DUALLINK_MASTER	0x40
#  define SIL164_CONTROL2_SYNC_CONT		0x80
#define SIL164_DUALLINK				0xd
#  define SIL164_DUALLINK_ENABLE		0x10
#  define SIL164_DUALLINK_SKEW_SHIFT		5
#define SIL164_PLLZONE				0xe
#  define SIL164_PLLZONE_STAT			0x08
#  define SIL164_PLLZONE_FORCE_ON		0x10
#  define SIL164_PLLZONE_FORCE_HIGH		0x20

/* HW access functions */

static void
sil164_write(struct i2c_client *client, uint8_t addr, uint8_t val)
{
	uint8_t buf[] = {addr, val};
	int ret;

	ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
	if (ret < 0)
		sil164_err(client, "Error %d writing to subaddress 0x%x\n",
			   ret, addr);
}

static uint8_t
sil164_read(struct i2c_client *client, uint8_t addr)
{
	uint8_t val;
	int ret;

	ret = i2c_master_send(client, &addr, sizeof(addr));
	if (ret < 0)
		goto fail;

	ret = i2c_master_recv(client, &val, sizeof(val));
	if (ret < 0)
		goto fail;

	return val;

fail:
	sil164_err(client, "Error %d reading from subaddress 0x%x\n",
		   ret, addr);
	return 0;
}

static void
sil164_save_state(struct i2c_client *client, uint8_t *state)
{
	int i;

	for (i = 0x8; i <= 0xe; i++)
		state[i] = sil164_read(client, i);
}

static void
sil164_restore_state(struct i2c_client *client, uint8_t *state)
{
	int i;

	for (i = 0x8; i <= 0xe; i++)
		sil164_write(client, i, state[i]);
}

static void
sil164_set_power_state(struct i2c_client *client, bool on)
{
	uint8_t control0 = sil164_read(client, SIL164_CONTROL0);

	if (on)
		control0 |= SIL164_CONTROL0_POWER_ON;
	else
		control0 &= ~SIL164_CONTROL0_POWER_ON;

	sil164_write(client, SIL164_CONTROL0, control0);
}

static void
sil164_init_state(struct i2c_client *client,
		  struct sil164_encoder_params *config,
		  bool duallink)
{
	sil164_write(client, SIL164_CONTROL0,
		     SIL164_CONTROL0_HSYNC_ON |
		     SIL164_CONTROL0_VSYNC_ON |
		     (config->input_edge ? SIL164_CONTROL0_EDGE_RISING : 0) |
		     (config->input_width ? SIL164_CONTROL0_INPUT_24BIT : 0) |
		     (config->input_dual ? SIL164_CONTROL0_DUAL_EDGE : 0));

	sil164_write(client, SIL164_DETECT,
		     SIL164_DETECT_INTR_STAT |
		     SIL164_DETECT_OUT_MODE_RECEIVER);

	sil164_write(client, SIL164_CONTROL1,
		     (config->input_skew ? SIL164_CONTROL1_DESKEW_ENABLE : 0) |
		     (((config->input_skew + 4) & 0x7)
		      << SIL164_CONTROL1_DESKEW_INCR_SHIFT));

	sil164_write(client, SIL164_CONTROL2,
		     SIL164_CONTROL2_SYNC_CONT |
		     (config->pll_filter ? 0 : SIL164_CONTROL2_FILTER_ENABLE) |
		     (4 << SIL164_CONTROL2_FILTER_SETTING_SHIFT));

	sil164_write(client, SIL164_PLLZONE, 0);

	if (duallink)
		sil164_write(client, SIL164_DUALLINK,
			     SIL164_DUALLINK_ENABLE |
			     (((config->duallink_skew + 4) & 0x7)
			      << SIL164_DUALLINK_SKEW_SHIFT));
	else
		sil164_write(client, SIL164_DUALLINK, 0);
}

/* DRM encoder functions */

static void
sil164_encoder_set_config(struct drm_encoder *encoder, void *params)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);

	priv->config = *(struct sil164_encoder_params *)params;
}

static void
sil164_encoder_dpms(struct drm_encoder *encoder, int mode)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);
	bool on = (mode == DRM_MODE_DPMS_ON);
	bool duallink = (on && encoder->crtc->mode.clock > 165000);

	sil164_set_power_state(drm_i2c_encoder_get_client(encoder), on);

	if (priv->duallink_slave)
		sil164_set_power_state(priv->duallink_slave, duallink);
}

static void
sil164_encoder_save(struct drm_encoder *encoder)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);

	sil164_save_state(drm_i2c_encoder_get_client(encoder),
			  priv->saved_state);

	if (priv->duallink_slave)
		sil164_save_state(priv->duallink_slave,
				  priv->saved_slave_state);
}

static void
sil164_encoder_restore(struct drm_encoder *encoder)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);

	sil164_restore_state(drm_i2c_encoder_get_client(encoder),
			     priv->saved_state);

	if (priv->duallink_slave)
		sil164_restore_state(priv->duallink_slave,
				     priv->saved_slave_state);
}

static bool
sil164_encoder_mode_fixup(struct drm_encoder *encoder,
			  const struct drm_display_mode *mode,
			  struct drm_display_mode *adjusted_mode)
{
	return true;
}

static int
sil164_encoder_mode_valid(struct drm_encoder *encoder,
			  struct drm_display_mode *mode)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);

	if (mode->clock < 32000)
		return MODE_CLOCK_LOW;

	if (mode->clock > 330000 ||
	    (mode->clock > 165000 && !priv->duallink_slave))
		return MODE_CLOCK_HIGH;

	return MODE_OK;
}

static void
sil164_encoder_mode_set(struct drm_encoder *encoder,
			struct drm_display_mode *mode,
			struct drm_display_mode *adjusted_mode)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);
	bool duallink = adjusted_mode->clock > 165000;

	sil164_init_state(drm_i2c_encoder_get_client(encoder),
			  &priv->config, duallink);

	if (priv->duallink_slave)
		sil164_init_state(priv->duallink_slave,
				  &priv->config, duallink);

	sil164_encoder_dpms(encoder, DRM_MODE_DPMS_ON);
}

static enum drm_connector_status
sil164_encoder_detect(struct drm_encoder *encoder,
		      struct drm_connector *connector)
{
	struct i2c_client *client = drm_i2c_encoder_get_client(encoder);

	if (sil164_read(client, SIL164_DETECT) & SIL164_DETECT_HOTPLUG_STAT)
		return connector_status_connected;
	else
		return connector_status_disconnected;
}

static int
sil164_encoder_get_modes(struct drm_encoder *encoder,
			 struct drm_connector *connector)
{
	return 0;
}

static int
sil164_encoder_create_resources(struct drm_encoder *encoder,
				struct drm_connector *connector)
{
	return 0;
}

static int
sil164_encoder_set_property(struct drm_encoder *encoder,
			    struct drm_connector *connector,
			    struct drm_property *property,
			    uint64_t val)
{
	return 0;
}

static void
sil164_encoder_destroy(struct drm_encoder *encoder)
{
	struct sil164_priv *priv = to_sil164_priv(encoder);

	if (priv->duallink_slave)
		i2c_unregister_device(priv->duallink_slave);

	kfree(priv);
	drm_i2c_encoder_destroy(encoder);
}

static struct drm_encoder_slave_funcs sil164_encoder_funcs = {
	.set_config = sil164_encoder_set_config,
	.destroy = sil164_encoder_destroy,
	.dpms = sil164_encoder_dpms,
	.save = sil164_encoder_save,
	.restore = sil164_encoder_restore,
	.mode_fixup = sil164_encoder_mode_fixup,
	.mode_valid = sil164_encoder_mode_valid,
	.mode_set = sil164_encoder_mode_set,
	.detect = sil164_encoder_detect,
	.get_modes = sil164_encoder_get_modes,
	.create_resources = sil164_encoder_create_resources,
	.set_property = sil164_encoder_set_property,
};

/* I2C driver functions */

static int
sil164_probe(struct i2c_client *client, const struct i2c_device_id *id)
{
	int vendor = sil164_read(client, SIL164_VENDOR_HI) << 8 |
		sil164_read(client, SIL164_VENDOR_LO);
	int device = sil164_read(client, SIL164_DEVICE_HI) << 8 |
		sil164_read(client, SIL164_DEVICE_LO);
	int rev = sil164_read(client, SIL164_REVISION);

	if (vendor != 0x1 || device != 0x6) {
		sil164_dbg(client, "Unknown device %x:%x.%x\n",
			   vendor, device, rev);
		return -ENODEV;
	}

	sil164_info(client, "Detected device %x:%x.%x\n",
		    vendor, device, rev);

	return 0;
}

static int
sil164_remove(struct i2c_client *client)
{
	return 0;
}

static struct i2c_client *
sil164_detect_slave(struct i2c_client *client)
{
	struct i2c_adapter *adap = client->adapter;
	struct i2c_msg msg = {
		.addr = SIL164_I2C_ADDR_SLAVE,
		.len = 0,
	};
	const struct i2c_board_info info = {
		I2C_BOARD_INFO("sil164", SIL164_I2C_ADDR_SLAVE)
	};

	if (i2c_transfer(adap, &msg, 1) != 1) {
		sil164_dbg(adap, "No dual-link slave found.");
		return NULL;
	}

	return i2c_new_device(adap, &info);
}

static int
sil164_encoder_init(struct i2c_client *client,
		    struct drm_device *dev,
		    struct drm_encoder_slave *encoder)
{
	struct sil164_priv *priv;

	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	encoder->slave_priv = priv;
	encoder->slave_funcs = &sil164_encoder_funcs;

	priv->duallink_slave = sil164_detect_slave(client);

	return 0;
}

static struct i2c_device_id sil164_ids[] = {
	{ "sil164", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, sil164_ids);

static struct drm_i2c_encoder_driver sil164_driver = {
	.i2c_driver = {
		.probe = sil164_probe,
		.remove = sil164_remove,
		.driver = {
			.name = "sil164",
		},
		.id_table = sil164_ids,
	},
	.encoder_init = sil164_encoder_init,
};

/* Module initialization */

static int __init
sil164_init(void)
{
	return drm_i2c_encoder_register(THIS_MODULE, &sil164_driver);
}

static void __exit
sil164_exit(void)
{
	drm_i2c_encoder_unregister(&sil164_driver);
}

MODULE_AUTHOR("Francisco Jerez <currojerez@riseup.net>");
MODULE_DESCRIPTION("Silicon Image sil164 TMDS transmitter driver");
MODULE_LICENSE("GPL and additional rights");

module_init(sil164_init);
module_exit(sil164_exit);
Commit	Line	Data
e190bfe5 FJ	1	/*
	2	* Copyright (C) 2010 Francisco Jerez.
	3	* All Rights Reserved.
	4	*
	5	* Permission is hereby granted, free of charge, to any person obtaining
	6	* a copy of this software and associated documentation files (the
	7	* "Software"), to deal in the Software without restriction, including
	8	* without limitation the rights to use, copy, modify, merge, publish,
	9	* distribute, sublicense, and/or sell copies of the Software, and to
	10	* permit persons to whom the Software is furnished to do so, subject to
	11	* the following conditions:
	12	*
	13	* The above copyright notice and this permission notice (including the
	14	* next paragraph) shall be included in all copies or substantial
	15	* portions of the Software.
	16	*
	17	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	18	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	19	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
	20	* IN NO EVENT SHALL THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE
	21	* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
	22	* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
	23	* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
	24	*
	25	*/
	26
e0cd3608 PG	27	#include <linux/module.h>
e0cd3608 PG	28
760285e7 DH	29	#include <drm/drmP.h>
	30	#include <drm/drm_crtc_helper.h>
	31	#include <drm/drm_encoder_slave.h>
	32	#include <drm/i2c/sil164.h>
e190bfe5 FJ	33
	34	struct sil164_priv {
	35	struct sil164_encoder_params config;
	36	struct i2c_client *duallink_slave;
	37
	38	uint8_t saved_state[0x10];
	39	uint8_t saved_slave_state[0x10];
	40	};
	41
	42	#define to_sil164_priv(x) \
	43	((struct sil164_priv *)to_encoder_slave(x)->slave_priv)
	44
	45	#define sil164_dbg(client, format, ...) do { \
	46	if (drm_debug & DRM_UT_KMS) \
	47	dev_printk(KERN_DEBUG, &client->dev, \
	48	"%s: " format, __func__, ## __VA_ARGS__); \
	49	} while (0)
	50	#define sil164_info(client, format, ...) \
	51	dev_info(&client->dev, format, __VA_ARGS__)
	52	#define sil164_err(client, format, ...) \
	53	dev_err(&client->dev, format, __VA_ARGS__)
	54
	55	#define SIL164_I2C_ADDR_MASTER 0x38
	56	#define SIL164_I2C_ADDR_SLAVE 0x39
	57
	58	/* HW register definitions */
	59
	60	#define SIL164_VENDOR_LO 0x0
	61	#define SIL164_VENDOR_HI 0x1
	62	#define SIL164_DEVICE_LO 0x2
	63	#define SIL164_DEVICE_HI 0x3
	64	#define SIL164_REVISION 0x4
	65	#define SIL164_FREQ_MIN 0x6
	66	#define SIL164_FREQ_MAX 0x7
	67	#define SIL164_CONTROL0 0x8
	68	# define SIL164_CONTROL0_POWER_ON 0x01
	69	# define SIL164_CONTROL0_EDGE_RISING 0x02
	70	# define SIL164_CONTROL0_INPUT_24BIT 0x04
	71	# define SIL164_CONTROL0_DUAL_EDGE 0x08
	72	# define SIL164_CONTROL0_HSYNC_ON 0x10
	73	# define SIL164_CONTROL0_VSYNC_ON 0x20
	74	#define SIL164_DETECT 0x9
	75	# define SIL164_DETECT_INTR_STAT 0x01
	76	# define SIL164_DETECT_HOTPLUG_STAT 0x02
	77	# define SIL164_DETECT_RECEIVER_STAT 0x04
	78	# define SIL164_DETECT_INTR_MODE_RECEIVER 0x00
	79	# define SIL164_DETECT_INTR_MODE_HOTPLUG 0x08
	80	# define SIL164_DETECT_OUT_MODE_HIGH 0x00
	81	# define SIL164_DETECT_OUT_MODE_INTR 0x10
	82	# define SIL164_DETECT_OUT_MODE_RECEIVER 0x20
	83	# define SIL164_DETECT_OUT_MODE_HOTPLUG 0x30
	84	# define SIL164_DETECT_VSWING_STAT 0x80
	85	#define SIL164_CONTROL1 0xa
	86	# define SIL164_CONTROL1_DESKEW_ENABLE 0x10
	87	# define SIL164_CONTROL1_DESKEW_INCR_SHIFT 5
	88	#define SIL164_GPIO 0xb
	89	#define SIL164_CONTROL2 0xc
	90	# define SIL164_CONTROL2_FILTER_ENABLE 0x01
	91	# define SIL164_CONTROL2_FILTER_SETTING_SHIFT 1
	92	# define SIL164_CONTROL2_DUALLINK_MASTER 0x40
	93	# define SIL164_CONTROL2_SYNC_CONT 0x80
	94	#define SIL164_DUALLINK 0xd
	95	# define SIL164_DUALLINK_ENABLE 0x10
	96	# define SIL164_DUALLINK_SKEW_SHIFT 5
97	#define SIL164_PLLZONE 0xe
98	# define SIL164_PLLZONE_STAT 0x08
99	# define SIL164_PLLZONE_FORCE_ON 0x10
100	# define SIL164_PLLZONE_FORCE_HIGH 0x20
101
102	/* HW access functions */
103
104	static void
105	sil164_write(struct i2c_client *client, uint8_t addr, uint8_t val)
106	{
107	uint8_t buf[] = {addr, val};
108	int ret;
109
110	ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
111	if (ret < 0)
112	sil164_err(client, "Error %d writing to subaddress 0x%x\n",
113	ret, addr);
114	}
115
116	static uint8_t
117	sil164_read(struct i2c_client *client, uint8_t addr)
118	{
119	uint8_t val;
120	int ret;
121
122	ret = i2c_master_send(client, &addr, sizeof(addr));
123	if (ret < 0)
124	goto fail;
125
126	ret = i2c_master_recv(client, &val, sizeof(val));
127	if (ret < 0)
128	goto fail;
129
130	return val;
131
132	fail:
133	sil164_err(client, "Error %d reading from subaddress 0x%x\n",
134	ret, addr);
135	return 0;
136	}
137
138	static void
139	sil164_save_state(struct i2c_client client, uint8_t state)
140	{
141	int i;
142
143	for (i = 0x8; i <= 0xe; i++)
144	state[i] = sil164_read(client, i);
145	}
146
147	static void
148	sil164_restore_state(struct i2c_client client, uint8_t state)
149	{
150	int i;
151
152	for (i = 0x8; i <= 0xe; i++)
153	sil164_write(client, i, state[i]);
154	}
155
156	static void
157	sil164_set_power_state(struct i2c_client *client, bool on)
158	{
159	uint8_t control0 = sil164_read(client, SIL164_CONTROL0);
160
161	if (on)
162	control0 \|= SIL164_CONTROL0_POWER_ON;
163	else
164	control0 &= ~SIL164_CONTROL0_POWER_ON;
165
166	sil164_write(client, SIL164_CONTROL0, control0);
167	}
168
169	static void
170	sil164_init_state(struct i2c_client *client,
171	struct sil164_encoder_params *config,
172	bool duallink)
173	{
174	sil164_write(client, SIL164_CONTROL0,
175	SIL164_CONTROL0_HSYNC_ON \|
176	SIL164_CONTROL0_VSYNC_ON \|
177	(config->input_edge ? SIL164_CONTROL0_EDGE_RISING : 0) \|
178	(config->input_width ? SIL164_CONTROL0_INPUT_24BIT : 0) \|
179	(config->input_dual ? SIL164_CONTROL0_DUAL_EDGE : 0));
180
181	sil164_write(client, SIL164_DETECT,
182	SIL164_DETECT_INTR_STAT \|
183	SIL164_DETECT_OUT_MODE_RECEIVER);
184
185	sil164_write(client, SIL164_CONTROL1,
186	(config->input_skew ? SIL164_CONTROL1_DESKEW_ENABLE : 0) \|
187	(((config->input_skew + 4) & 0x7)
188	<< SIL164_CONTROL1_DESKEW_INCR_SHIFT));
189
190	sil164_write(client, SIL164_CONTROL2,
191	SIL164_CONTROL2_SYNC_CONT \|
192	(config->pll_filter ? 0 : SIL164_CONTROL2_FILTER_ENABLE) \|
193	(4 << SIL164_CONTROL2_FILTER_SETTING_SHIFT));
194
195	sil164_write(client, SIL164_PLLZONE, 0);
196
197	if (duallink)
198	sil164_write(client, SIL164_DUALLINK,
199	SIL164_DUALLINK_ENABLE \|
200	(((config->duallink_skew + 4) & 0x7)
201	<< SIL164_DUALLINK_SKEW_SHIFT));
202	else
203	sil164_write(client, SIL164_DUALLINK, 0);
204	}
205
206	/* DRM encoder functions */
207
208	static void
209	sil164_encoder_set_config(struct drm_encoder encoder, void params)
210	{
211	struct sil164_priv *priv = to_sil164_priv(encoder);
212
213	priv->config = (struct sil164_encoder_params )params;
214	}
215
216	static void
217	sil164_encoder_dpms(struct drm_encoder *encoder, int mode)
218	{
219	struct sil164_priv *priv = to_sil164_priv(encoder);
220	bool on = (mode == DRM_MODE_DPMS_ON);
221	bool duallink = (on && encoder->crtc->mode.clock > 165000);
222
223	sil164_set_power_state(drm_i2c_encoder_get_client(encoder), on);
224
225	if (priv->duallink_slave)
226	sil164_set_power_state(priv->duallink_slave, duallink);
227	}
228
229	static void
230	sil164_encoder_save(struct drm_encoder *encoder)
231	{
232	struct sil164_priv *priv = to_sil164_priv(encoder);
233
234	sil164_save_state(drm_i2c_encoder_get_client(encoder),
235	priv->saved_state);
236
237	if (priv->duallink_slave)
238	sil164_save_state(priv->duallink_slave,
239	priv->saved_slave_state);
240	}
241
242	static void
243	sil164_encoder_restore(struct drm_encoder *encoder)
244	{
245	struct sil164_priv *priv = to_sil164_priv(encoder);
246
247	sil164_restore_state(drm_i2c_encoder_get_client(encoder),
248	priv->saved_state);
249
250	if (priv->duallink_slave)
251	sil164_restore_state(priv->duallink_slave,
252	priv->saved_slave_state);
253	}
254
255	static bool
256	sil164_encoder_mode_fixup(struct drm_encoder *encoder,
e811f5ae	257	const struct drm_display_mode *mode,
e190bfe5 FJ	258	struct drm_display_mode *adjusted_mode)
	259	{
	260	return true;
	261	}
	262
	263	static int
	264	sil164_encoder_mode_valid(struct drm_encoder *encoder,
	265	struct drm_display_mode *mode)
	266	{
	267	struct sil164_priv *priv = to_sil164_priv(encoder);
	268
	269	if (mode->clock < 32000)
	270	return MODE_CLOCK_LOW;
	271
	272	if (mode->clock > 330000 \|\|
	273	(mode->clock > 165000 && !priv->duallink_slave))
	274	return MODE_CLOCK_HIGH;
	275
	276	return MODE_OK;
	277	}
	278
	279	static void
	280	sil164_encoder_mode_set(struct drm_encoder *encoder,
	281	struct drm_display_mode *mode,
	282	struct drm_display_mode *adjusted_mode)
	283	{
	284	struct sil164_priv *priv = to_sil164_priv(encoder);
	285	bool duallink = adjusted_mode->clock > 165000;
	286
	287	sil164_init_state(drm_i2c_encoder_get_client(encoder),
	288	&priv->config, duallink);
	289
	290	if (priv->duallink_slave)
	291	sil164_init_state(priv->duallink_slave,
	292	&priv->config, duallink);
	293
	294	sil164_encoder_dpms(encoder, DRM_MODE_DPMS_ON);
	295	}
	296
	297	static enum drm_connector_status
	298	sil164_encoder_detect(struct drm_encoder *encoder,
	299	struct drm_connector *connector)
	300	{
	301	struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
	302
	303	if (sil164_read(client, SIL164_DETECT) & SIL164_DETECT_HOTPLUG_STAT)
	304	return connector_status_connected;
	305	else
	306	return connector_status_disconnected;
	307	}
	308
	309	static int
	310	sil164_encoder_get_modes(struct drm_encoder *encoder,
	311	struct drm_connector *connector)
	312	{
	313	return 0;
	314	}
	315
	316	static int
	317	sil164_encoder_create_resources(struct drm_encoder *encoder,
	318	struct drm_connector *connector)
	319	{
	320	return 0;
	321	}
322
323	static int
324	sil164_encoder_set_property(struct drm_encoder *encoder,
325	struct drm_connector *connector,
326	struct drm_property *property,
327	uint64_t val)
328	{
329	return 0;
330	}
331
332	static void
333	sil164_encoder_destroy(struct drm_encoder *encoder)
334	{
335	struct sil164_priv *priv = to_sil164_priv(encoder);
336
337	if (priv->duallink_slave)
338	i2c_unregister_device(priv->duallink_slave);
339
340	kfree(priv);
341	drm_i2c_encoder_destroy(encoder);
342	}
343
344	static struct drm_encoder_slave_funcs sil164_encoder_funcs = {
345	.set_config = sil164_encoder_set_config,
346	.destroy = sil164_encoder_destroy,
347	.dpms = sil164_encoder_dpms,
348	.save = sil164_encoder_save,
349	.restore = sil164_encoder_restore,
350	.mode_fixup = sil164_encoder_mode_fixup,
351	.mode_valid = sil164_encoder_mode_valid,
352	.mode_set = sil164_encoder_mode_set,
353	.detect = sil164_encoder_detect,
354	.get_modes = sil164_encoder_get_modes,
355	.create_resources = sil164_encoder_create_resources,
356	.set_property = sil164_encoder_set_property,
357	};
358
359	/* I2C driver functions */
360
361	static int
362	sil164_probe(struct i2c_client client, const struct i2c_device_id id)
363	{
364	int vendor = sil164_read(client, SIL164_VENDOR_HI) << 8 \|
365	sil164_read(client, SIL164_VENDOR_LO);
366	int device = sil164_read(client, SIL164_DEVICE_HI) << 8 \|
367	sil164_read(client, SIL164_DEVICE_LO);
368	int rev = sil164_read(client, SIL164_REVISION);
369
370	if (vendor != 0x1 \|\| device != 0x6) {
371	sil164_dbg(client, "Unknown device %x:%x.%x\n",
372	vendor, device, rev);
373	return -ENODEV;
374	}
375
376	sil164_info(client, "Detected device %x:%x.%x\n",
377	vendor, device, rev);
378
379	return 0;
380	}
381
382	static int
383	sil164_remove(struct i2c_client *client)
384	{
385	return 0;
386	}
387
388	static struct i2c_client *
389	sil164_detect_slave(struct i2c_client *client)
390	{
391	struct i2c_adapter *adap = client->adapter;
392	struct i2c_msg msg = {
393	.addr = SIL164_I2C_ADDR_SLAVE,
394	.len = 0,
395	};
396	const struct i2c_board_info info = {
397	I2C_BOARD_INFO("sil164", SIL164_I2C_ADDR_SLAVE)
398	};
399
400	if (i2c_transfer(adap, &msg, 1) != 1) {
401	sil164_dbg(adap, "No dual-link slave found.");
402	return NULL;
403	}
404
405	return i2c_new_device(adap, &info);
406	}
407
408	static int
409	sil164_encoder_init(struct i2c_client *client,
410	struct drm_device *dev,
411	struct drm_encoder_slave *encoder)
412	{
413	struct sil164_priv *priv;
414
415	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
416	if (!priv)
417	return -ENOMEM;
418
419	encoder->slave_priv = priv;
420	encoder->slave_funcs = &sil164_encoder_funcs;
421
422	priv->duallink_slave = sil164_detect_slave(client);
423
424	return 0;
425	}
426
427	static struct i2c_device_id sil164_ids[] = {
428	{ "sil164", 0 },
429	{ }
430	};
431	MODULE_DEVICE_TABLE(i2c, sil164_ids);
432
433	static struct drm_i2c_encoder_driver sil164_driver = {
434	.i2c_driver = {
435	.probe = sil164_probe,
436	.remove = sil164_remove,
437	.driver = {
438	.name = "sil164",
439	},
440	.id_table = sil164_ids,
441	},
442	.encoder_init = sil164_encoder_init,
443	};
444
445	/* Module initialization */
446
447	static int __init
448	sil164_init(void)
449	{
450	return drm_i2c_encoder_register(THIS_MODULE, &sil164_driver);
451	}
452
453	static void __exit
454	sil164_exit(void)
455	{
456	drm_i2c_encoder_unregister(&sil164_driver);
457	}
458
459	MODULE_AUTHOR("Francisco Jerez <currojerez@riseup.net>");
460	MODULE_DESCRIPTION("Silicon Image sil164 TMDS transmitter driver");
461	MODULE_LICENSE("GPL and additional rights");
462
463	module_init(sil164_init);
464	module_exit(sil164_exit);