1/*
2 *
3 * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200, G400 and G450.
4 *
5 * (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz>
6 *
7 * Version: 1.64 2002/06/10
8 *
9 * See matroxfb_base.c for contributors.
10 *
11 */
12
13#include "matroxfb_base.h"
14#include "matroxfb_maven.h"
15#include <linux/i2c.h>
16#include <linux/i2c-algo-bit.h>
17
18/* MGA-TVO I2C for G200, G400 */
19#define MAT_CLK		0x20
20#define MAT_DATA	0x10
21/* primary head DDC for Mystique(?), G100, G200, G400 */
22#define DDC1_CLK	0x08
23#define DDC1_DATA	0x02
24/* primary head DDC for Millennium, Millennium II */
25#define DDC1B_CLK	0x10
26#define DDC1B_DATA	0x04
27/* secondary head DDC for G400 */
28#define DDC2_CLK	0x04
29#define DDC2_DATA	0x01
30
31/******************************************************/
32
33struct matroxfb_dh_maven_info {
34	struct i2c_bit_adapter	maven;
35	struct i2c_bit_adapter	ddc1;
36	struct i2c_bit_adapter	ddc2;
37};
38
39static int matroxfb_read_gpio(struct matrox_fb_info* minfo) {
40	unsigned long flags;
41	int v;
42
43	matroxfb_DAC_lock_irqsave(flags);
44	v = matroxfb_DAC_in(PMINFO DAC_XGENIODATA);
45	matroxfb_DAC_unlock_irqrestore(flags);
46	return v;
47}
48
49static void matroxfb_set_gpio(struct matrox_fb_info* minfo, int mask, int val) {
50	unsigned long flags;
51	int v;
52
53	matroxfb_DAC_lock_irqsave(flags);
54	v = (matroxfb_DAC_in(PMINFO DAC_XGENIOCTRL) & mask) | val;
55	matroxfb_DAC_out(PMINFO DAC_XGENIOCTRL, v);
56	/* We must reset GENIODATA very often... XFree plays with this register */
57	matroxfb_DAC_out(PMINFO DAC_XGENIODATA, 0x00);
58	matroxfb_DAC_unlock_irqrestore(flags);
59}
60
61/* software I2C functions */
62static inline void matroxfb_i2c_set(struct matrox_fb_info* minfo, int mask, int state) {
63	if (state)
64		state = 0;
65	else
66		state = mask;
67	matroxfb_set_gpio(minfo, ~mask, state);
68}
69
70static void matroxfb_gpio_setsda(void* data, int state) {
71	struct i2c_bit_adapter* b = data;
72	matroxfb_i2c_set(b->minfo, b->mask.data, state);
73}
74
75static void matroxfb_gpio_setscl(void* data, int state) {
76	struct i2c_bit_adapter* b = data;
77	matroxfb_i2c_set(b->minfo, b->mask.clock, state);
78}
79
80static int matroxfb_gpio_getsda(void* data) {
81	struct i2c_bit_adapter* b = data;
82	return (matroxfb_read_gpio(b->minfo) & b->mask.data) ? 1 : 0;
83}
84
85static int matroxfb_gpio_getscl(void* data) {
86	struct i2c_bit_adapter* b = data;
87	return (matroxfb_read_gpio(b->minfo) & b->mask.clock) ? 1 : 0;
88}
89
90static struct i2c_adapter matrox_i2c_adapter_template =
91{
92	.owner =	THIS_MODULE,
93	.id =		I2C_HW_B_G400,
94};
95
96static struct i2c_algo_bit_data matrox_i2c_algo_template =
97{
98	.setsda		= matroxfb_gpio_setsda,
99	.setscl		= matroxfb_gpio_setscl,
100	.getsda		= matroxfb_gpio_getsda,
101	.getscl		= matroxfb_gpio_getscl,
102	.udelay		= 10,
103	.timeout	= 100,
104};
105
106static int i2c_bus_reg(struct i2c_bit_adapter* b, struct matrox_fb_info* minfo,
107		unsigned int data, unsigned int clock, const char* name) {
108	int err;
109
110	b->minfo = minfo;
111	b->mask.data = data;
112	b->mask.clock = clock;
113	b->adapter = matrox_i2c_adapter_template;
114	snprintf(b->adapter.name, sizeof(b->adapter.name), name,
115		minfo->fbcon.node);
116	i2c_set_adapdata(&b->adapter, b);
117	b->adapter.algo_data = &b->bac;
118	b->adapter.dev.parent = &ACCESS_FBINFO(pcidev)->dev;
119	b->bac = matrox_i2c_algo_template;
120	b->bac.data = b;
121	err = i2c_bit_add_bus(&b->adapter);
122	b->initialized = !err;
123	return err;
124}
125
126static void i2c_bit_bus_del(struct i2c_bit_adapter* b) {
127	if (b->initialized) {
128		i2c_del_adapter(&b->adapter);
129		b->initialized = 0;
130	}
131}
132
133static inline void i2c_maven_done(struct matroxfb_dh_maven_info* minfo2) {
134	i2c_bit_bus_del(&minfo2->maven);
135}
136
137static inline void i2c_ddc1_done(struct matroxfb_dh_maven_info* minfo2) {
138	i2c_bit_bus_del(&minfo2->ddc1);
139}
140
141static inline void i2c_ddc2_done(struct matroxfb_dh_maven_info* minfo2) {
142	i2c_bit_bus_del(&minfo2->ddc2);
143}
144
145static void* i2c_matroxfb_probe(struct matrox_fb_info* minfo) {
146	int err;
147	unsigned long flags;
148	struct matroxfb_dh_maven_info* m2info;
149
150	m2info = kzalloc(sizeof(*m2info), GFP_KERNEL);
151	if (!m2info)
152		return NULL;
153
154	matroxfb_DAC_lock_irqsave(flags);
155	matroxfb_DAC_out(PMINFO DAC_XGENIODATA, 0xFF);
156	matroxfb_DAC_out(PMINFO DAC_XGENIOCTRL, 0x00);
157	matroxfb_DAC_unlock_irqrestore(flags);
158
159	switch (ACCESS_FBINFO(chip)) {
160		case MGA_2064:
161		case MGA_2164:
162			err = i2c_bus_reg(&m2info->ddc1, minfo, DDC1B_DATA, DDC1B_CLK, "DDC:fb%u #0");
163			break;
164		default:
165			err = i2c_bus_reg(&m2info->ddc1, minfo, DDC1_DATA, DDC1_CLK, "DDC:fb%u #0");
166			break;
167	}
168	if (err)
169		goto fail_ddc1;
170	if (ACCESS_FBINFO(devflags.dualhead)) {
171		err = i2c_bus_reg(&m2info->ddc2, minfo, DDC2_DATA, DDC2_CLK, "DDC:fb%u #1");
172		if (err == -ENODEV) {
173			printk(KERN_INFO "i2c-matroxfb: VGA->TV plug detected, DDC unavailable.\n");
174		} else if (err)
175			printk(KERN_INFO "i2c-matroxfb: Could not register secondary output i2c bus. Continuing anyway.\n");
176		/* Register maven bus even on G450/G550 */
177		err = i2c_bus_reg(&m2info->maven, minfo, MAT_DATA, MAT_CLK, "MAVEN:fb%u");
178		if (err)
179			printk(KERN_INFO "i2c-matroxfb: Could not register Maven i2c bus. Continuing anyway.\n");
180	}
181	return m2info;
182fail_ddc1:;
183	kfree(m2info);
184	printk(KERN_ERR "i2c-matroxfb: Could not register primary adapter DDC bus.\n");
185	return NULL;
186}
187
188static void i2c_matroxfb_remove(struct matrox_fb_info* minfo, void* data) {
189	struct matroxfb_dh_maven_info* m2info = data;
190
191	i2c_maven_done(m2info);
192	i2c_ddc2_done(m2info);
193	i2c_ddc1_done(m2info);
194	kfree(m2info);
195}
196
197static struct matroxfb_driver i2c_matroxfb = {
198	.node =		LIST_HEAD_INIT(i2c_matroxfb.node),
199	.name =		"i2c-matroxfb",
200	.probe = 	i2c_matroxfb_probe,
201	.remove =	i2c_matroxfb_remove,
202};
203
204static int __init i2c_matroxfb_init(void) {
205	if (matroxfb_register_driver(&i2c_matroxfb)) {
206		printk(KERN_ERR "i2c-matroxfb: failed to register driver\n");
207		return -ENXIO;
208	}
209	return 0;
210}
211
212static void __exit i2c_matroxfb_exit(void) {
213	matroxfb_unregister_driver(&i2c_matroxfb);
214}
215
216MODULE_AUTHOR("(c) 1999-2002 Petr Vandrovec <vandrove@vc.cvut.cz>");
217MODULE_DESCRIPTION("Support module providing I2C buses present on Matrox videocards");
218
219module_init(i2c_matroxfb_init);
220module_exit(i2c_matroxfb_exit);
221/* no __setup required */
222MODULE_LICENSE("GPL");
223