Release 4.11 drivers/video/fbdev/savage/savagefb-i2c.c

/*
 * linux/drivers/video/savage/savagefb-i2c.c - S3 Savage DDC2
 *
 * Copyright 2004 Antonino A. Daplas <adaplas @pol.net>
 *
 * Based partly on rivafb-i2c.c
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file COPYING in the main directory of this archive
 * for more details.
 */

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

#include <asm/io.h>
#include "savagefb.h"


#define SAVAGE_DDC 	0x50


#define VGA_CR_IX	0x3d4

#define VGA_CR_DATA	0x3d5


#define CR_SERIAL1	0xa0	
/* I2C serial communications interface */

#define MM_SERIAL1	0xff20

#define CR_SERIAL2	0xb1	
/* DDC2 monitor communications interface */

/* based on vt8365 documentation */

#define PROSAVAGE_I2C_ENAB	0x10

#define PROSAVAGE_I2C_SCL_OUT	0x01

#define PROSAVAGE_I2C_SDA_OUT	0x02

#define PROSAVAGE_I2C_SCL_IN	0x04

#define PROSAVAGE_I2C_SDA_IN	0x08


#define SAVAGE4_I2C_ENAB	0x00000020

#define SAVAGE4_I2C_SCL_OUT	0x00000001

#define SAVAGE4_I2C_SDA_OUT	0x00000002

#define SAVAGE4_I2C_SCL_IN	0x00000008

#define SAVAGE4_I2C_SDA_IN	0x00000010



static void savage4_gpio_setscl(void *data, int val)
{
	struct savagefb_i2c_chan *chan = data;
	unsigned int r;

	r = readl(chan->ioaddr + chan->reg);
	if(val)
		r |= SAVAGE4_I2C_SCL_OUT;
	else
		r &= ~SAVAGE4_I2C_SCL_OUT;
	writel(r, chan->ioaddr + chan->reg);
	readl(chan->ioaddr + chan->reg);	/* flush posted write */
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
76
100.00%
1
100.00%
Total
76
100.00%
1
100.00%



static void savage4_gpio_setsda(void *data, int val)
{
	struct savagefb_i2c_chan *chan = data;

	unsigned int r;
	r = readl(chan->ioaddr + chan->reg);
	if(val)
		r |= SAVAGE4_I2C_SDA_OUT;
	else
		r &= ~SAVAGE4_I2C_SDA_OUT;
	writel(r, chan->ioaddr + chan->reg);
	readl(chan->ioaddr + chan->reg);	/* flush posted write */
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
76
100.00%
1
100.00%
Total
76
100.00%
1
100.00%



static int savage4_gpio_getscl(void *data)
{
	struct savagefb_i2c_chan *chan = data;

	return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SCL_IN));
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
37
100.00%
1
100.00%
Total
37
100.00%
1
100.00%



static int savage4_gpio_getsda(void *data)
{
	struct savagefb_i2c_chan *chan = data;

	return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SDA_IN));
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
37
100.00%
1
100.00%
Total
37
100.00%
1
100.00%



static void prosavage_gpio_setscl(void* data, int val)
{
	struct savagefb_i2c_chan *chan = data;
	u32			  r;

	r = VGArCR(chan->reg, chan->par);
	r |= PROSAVAGE_I2C_ENAB;
	if (val) {
		r |= PROSAVAGE_I2C_SCL_OUT;
	} else {
		r &= ~PROSAVAGE_I2C_SCL_OUT;
	}

	VGAwCR(chan->reg, r, chan->par);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
71
100.00%
2
100.00%
Total
71
100.00%
2
100.00%



static void prosavage_gpio_setsda(void* data, int val)
{
	struct savagefb_i2c_chan *chan = data;
	unsigned int r;

	r = VGArCR(chan->reg, chan->par);
	r |= PROSAVAGE_I2C_ENAB;
	if (val) {
		r |= PROSAVAGE_I2C_SDA_OUT;
	} else {
		r &= ~PROSAVAGE_I2C_SDA_OUT;
	}

	VGAwCR(chan->reg, r, chan->par);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
72
100.00%
2
100.00%
Total
72
100.00%
2
100.00%



static int prosavage_gpio_getscl(void* data)
{
	struct savagefb_i2c_chan *chan = data;

	return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SCL_IN) ? 1 : 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
37
100.00%
2
100.00%
Total
37
100.00%
2
100.00%



static int prosavage_gpio_getsda(void* data)
{
	struct savagefb_i2c_chan *chan = data;

	return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SDA_IN) ? 1 : 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
37
100.00%
2
100.00%
Total
37
100.00%
2
100.00%



static int savage_setup_i2c_bus(struct savagefb_i2c_chan *chan,
				const char *name)
{
	int rc = 0;

	if (chan->par) {
		strcpy(chan->adapter.name, name);
		chan->adapter.owner		= THIS_MODULE;
		chan->adapter.algo_data		= &chan->algo;
		chan->adapter.dev.parent	= &chan->par->pcidev->dev;
		chan->algo.udelay		= 10;
		chan->algo.timeout		= 20;
		chan->algo.data 		= chan;

		i2c_set_adapdata(&chan->adapter, chan);

		/* Raise SCL and SDA */
		chan->algo.setsda(chan, 1);
		chan->algo.setscl(chan, 1);
		udelay(20);

		rc = i2c_bit_add_bus(&chan->adapter);

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

	return rc;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
189
99.47%
3
75.00%
Jean Delvare
1
0.53%
1
25.00%
Total
190
100.00%
4
100.00%



void savagefb_create_i2c_busses(struct fb_info *info)
{
	struct savagefb_par *par = info->par;
	par->chan.par	= par;

	switch (par->chip) {
	case S3_PROSAVAGE:
	case S3_PROSAVAGEDDR:
	case S3_TWISTER:
		par->chan.reg         = CR_SERIAL2;
		par->chan.ioaddr      = par->mmio.vbase;
		par->chan.algo.setsda = prosavage_gpio_setsda;
		par->chan.algo.setscl = prosavage_gpio_setscl;
		par->chan.algo.getsda = prosavage_gpio_getsda;
		par->chan.algo.getscl = prosavage_gpio_getscl;
		break;
	case S3_SAVAGE4:
		par->chan.reg = CR_SERIAL1;
		if (par->pcidev->revision > 1 && !(VGArCR(0xa6, par) & 0x40))
			par->chan.reg = CR_SERIAL2;
		par->chan.ioaddr      = par->mmio.vbase;
		par->chan.algo.setsda = prosavage_gpio_setsda;
		par->chan.algo.setscl = prosavage_gpio_setscl;
		par->chan.algo.getsda = prosavage_gpio_getsda;
		par->chan.algo.getscl = prosavage_gpio_getscl;
		break;
	case S3_SAVAGE2000:
		par->chan.reg         = MM_SERIAL1;
		par->chan.ioaddr      = par->mmio.vbase;
		par->chan.algo.setsda = savage4_gpio_setsda;
		par->chan.algo.setscl = savage4_gpio_setscl;
		par->chan.algo.getsda = savage4_gpio_getsda;
		par->chan.algo.getscl = savage4_gpio_getscl;
		break;
	default:
		par->chan.par = NULL;
	}

	savage_setup_i2c_bus(&par->chan, "SAVAGE DDC2");
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
177
62.77%
2
28.57%
Ondrej Zary
91
32.27%
1
14.29%
Tormod Volden
12
4.26%
3
42.86%
Jean Delvare
2
0.71%
1
14.29%
Total
282
100.00%
7
100.00%



void savagefb_delete_i2c_busses(struct fb_info *info)
{
	struct savagefb_par *par = info->par;

	if (par->chan.par)
		i2c_del_adapter(&par->chan.adapter);

	par->chan.par = NULL;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
44
97.78%
1
50.00%
Jean Delvare
1
2.22%
1
50.00%
Total
45
100.00%
2
100.00%



int savagefb_probe_i2c_connector(struct fb_info *info, u8 **out_edid)
{
	struct savagefb_par *par = info->par;
	u8 *edid;

	if (par->chan.par)
		edid = fb_ddc_read(&par->chan.adapter);
	else
		edid = NULL;

	if (!edid) {
		/* try to get from firmware */
		const u8 *e = fb_firmware_edid(info->device);

		if (e)
			edid = kmemdup(e, EDID_LENGTH, GFP_KERNEL);
	}

	*out_edid = edid;

	return (edid) ? 0 : 1;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
99
97.06%
4
80.00%
Alexey Dobriyan
3
2.94%
1
20.00%
Total
102
100.00%
5
100.00%

MODULE_LICENSE("GPL");
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Antonino A. Daplas
1046
90.25%
8
47.06%
Ondrej Zary
91
7.85%
1
5.88%
Tormod Volden
12
1.04%
3
17.65%
Jean Delvare
4
0.35%
3
17.65%
Alexey Dobriyan
3
0.26%
1
5.88%
Tejun Heo
3
0.26%
1
5.88%
Total
1159
100.00%
17
100.00%
Directory: drivers/video/fbdev/savage

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.