2008-10-16 05:03:29 +00:00
|
|
|
/*
|
2009-05-22 16:35:39 +00:00
|
|
|
* Copyright 1998-2009 VIA Technologies, Inc. All Rights Reserved.
|
2008-10-16 05:03:29 +00:00
|
|
|
* Copyright 2001-2008 S3 Graphics, Inc. All Rights Reserved.
|
|
|
|
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public
|
|
|
|
* License as published by the Free Software Foundation;
|
|
|
|
* either version 2, or (at your option) any later version.
|
|
|
|
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTIES OR REPRESENTATIONS; without even
|
|
|
|
* the implied warranty of MERCHANTABILITY or FITNESS FOR
|
|
|
|
* A PARTICULAR PURPOSE.See the GNU General Public License
|
|
|
|
* for more details.
|
|
|
|
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc.,
|
|
|
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "global.h"
|
|
|
|
|
2009-12-02 03:29:39 +00:00
|
|
|
/*
|
|
|
|
* There can only be one set of these, so there's no point in having
|
|
|
|
* them be dynamically allocated...
|
|
|
|
*/
|
|
|
|
#define VIAFB_NUM_I2C 5
|
|
|
|
static struct via_i2c_stuff via_i2c_par[VIAFB_NUM_I2C];
|
|
|
|
|
2008-10-16 05:03:29 +00:00
|
|
|
static void via_i2c_setscl(void *data, int state)
|
|
|
|
{
|
|
|
|
u8 val;
|
2009-12-02 03:29:39 +00:00
|
|
|
struct via_port_cfg *adap_data = data;
|
2008-10-16 05:03:29 +00:00
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
val = viafb_read_reg(adap_data->io_port,
|
|
|
|
adap_data->ioport_index) & 0xF0;
|
2008-10-16 05:03:29 +00:00
|
|
|
if (state)
|
|
|
|
val |= 0x20;
|
|
|
|
else
|
|
|
|
val &= ~0x20;
|
2009-05-22 16:35:39 +00:00
|
|
|
switch (adap_data->type) {
|
2009-12-02 03:29:39 +00:00
|
|
|
case VIA_PORT_I2C:
|
2008-10-16 05:03:29 +00:00
|
|
|
val |= 0x01;
|
|
|
|
break;
|
2009-12-02 03:29:39 +00:00
|
|
|
case VIA_PORT_GPIO:
|
2008-10-16 05:03:29 +00:00
|
|
|
val |= 0x80;
|
|
|
|
break;
|
|
|
|
default:
|
2009-05-22 16:35:39 +00:00
|
|
|
DEBUG_MSG("viafb_i2c: specify wrong i2c type.\n");
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
2009-05-22 16:35:39 +00:00
|
|
|
viafb_write_reg(adap_data->ioport_index,
|
|
|
|
adap_data->io_port, val);
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int via_i2c_getscl(void *data)
|
|
|
|
{
|
2009-12-02 03:29:39 +00:00
|
|
|
struct via_port_cfg *adap_data = data;
|
2008-10-16 05:03:29 +00:00
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
if (viafb_read_reg(adap_data->io_port, adap_data->ioport_index) & 0x08)
|
2008-10-16 05:03:29 +00:00
|
|
|
return 1;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int via_i2c_getsda(void *data)
|
|
|
|
{
|
2009-12-02 03:29:39 +00:00
|
|
|
struct via_port_cfg *adap_data = data;
|
2008-10-16 05:03:29 +00:00
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
if (viafb_read_reg(adap_data->io_port, adap_data->ioport_index) & 0x04)
|
2008-10-16 05:03:29 +00:00
|
|
|
return 1;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void via_i2c_setsda(void *data, int state)
|
|
|
|
{
|
|
|
|
u8 val;
|
2009-12-02 03:29:39 +00:00
|
|
|
struct via_port_cfg *adap_data = data;
|
2008-10-16 05:03:29 +00:00
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
val = viafb_read_reg(adap_data->io_port,
|
|
|
|
adap_data->ioport_index) & 0xF0;
|
2008-10-16 05:03:29 +00:00
|
|
|
if (state)
|
|
|
|
val |= 0x10;
|
|
|
|
else
|
|
|
|
val &= ~0x10;
|
2009-05-22 16:35:39 +00:00
|
|
|
switch (adap_data->type) {
|
2009-12-02 03:29:39 +00:00
|
|
|
case VIA_PORT_I2C:
|
2008-10-16 05:03:29 +00:00
|
|
|
val |= 0x01;
|
|
|
|
break;
|
2009-12-02 03:29:39 +00:00
|
|
|
case VIA_PORT_GPIO:
|
2008-10-16 05:03:29 +00:00
|
|
|
val |= 0x40;
|
|
|
|
break;
|
|
|
|
default:
|
2009-05-22 16:35:39 +00:00
|
|
|
DEBUG_MSG("viafb_i2c: specify wrong i2c type.\n");
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
2009-05-22 16:35:39 +00:00
|
|
|
viafb_write_reg(adap_data->ioport_index,
|
|
|
|
adap_data->io_port, val);
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
int viafb_i2c_readbyte(u8 adap, u8 slave_addr, u8 index, u8 *pdata)
|
2008-10-16 05:03:29 +00:00
|
|
|
{
|
|
|
|
u8 mm1[] = {0x00};
|
|
|
|
struct i2c_msg msgs[2];
|
|
|
|
|
|
|
|
*pdata = 0;
|
|
|
|
msgs[0].flags = 0;
|
|
|
|
msgs[1].flags = I2C_M_RD;
|
|
|
|
msgs[0].addr = msgs[1].addr = slave_addr / 2;
|
|
|
|
mm1[0] = index;
|
|
|
|
msgs[0].len = 1; msgs[1].len = 1;
|
|
|
|
msgs[0].buf = mm1; msgs[1].buf = pdata;
|
2009-12-02 03:29:39 +00:00
|
|
|
return i2c_transfer(&via_i2c_par[adap].adapter, msgs, 2);
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
int viafb_i2c_writebyte(u8 adap, u8 slave_addr, u8 index, u8 data)
|
2008-10-16 05:03:29 +00:00
|
|
|
{
|
|
|
|
u8 msg[2] = { index, data };
|
|
|
|
struct i2c_msg msgs;
|
|
|
|
|
|
|
|
msgs.flags = 0;
|
|
|
|
msgs.addr = slave_addr / 2;
|
|
|
|
msgs.len = 2;
|
|
|
|
msgs.buf = msg;
|
2009-12-02 03:29:39 +00:00
|
|
|
return i2c_transfer(&via_i2c_par[adap].adapter, &msgs, 1);
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
int viafb_i2c_readbytes(u8 adap, u8 slave_addr, u8 index, u8 *buff, int buff_len)
|
2008-10-16 05:03:29 +00:00
|
|
|
{
|
|
|
|
u8 mm1[] = {0x00};
|
|
|
|
struct i2c_msg msgs[2];
|
|
|
|
|
|
|
|
msgs[0].flags = 0;
|
|
|
|
msgs[1].flags = I2C_M_RD;
|
|
|
|
msgs[0].addr = msgs[1].addr = slave_addr / 2;
|
|
|
|
mm1[0] = index;
|
|
|
|
msgs[0].len = 1; msgs[1].len = buff_len;
|
|
|
|
msgs[0].buf = mm1; msgs[1].buf = buff;
|
2009-12-02 03:29:39 +00:00
|
|
|
return i2c_transfer(&via_i2c_par[adap].adapter, msgs, 2);
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
static int create_i2c_bus(struct i2c_adapter *adapter,
|
|
|
|
struct i2c_algo_bit_data *algo,
|
2009-12-02 03:29:39 +00:00
|
|
|
struct via_port_cfg *adap_cfg,
|
2009-05-22 16:35:39 +00:00
|
|
|
struct pci_dev *pdev)
|
2008-10-16 05:03:29 +00:00
|
|
|
{
|
2009-10-07 15:13:01 +00:00
|
|
|
DEBUG_MSG(KERN_DEBUG "viafb: creating bus adap=0x%p, algo_bit_data=0x%p, adap_cfg=0x%p\n", adapter, algo, adap_cfg);
|
2009-05-22 16:35:39 +00:00
|
|
|
|
|
|
|
algo->setsda = via_i2c_setsda;
|
|
|
|
algo->setscl = via_i2c_setscl;
|
|
|
|
algo->getsda = via_i2c_getsda;
|
|
|
|
algo->getscl = via_i2c_getscl;
|
|
|
|
algo->udelay = 40;
|
|
|
|
algo->timeout = 20;
|
|
|
|
algo->data = adap_cfg;
|
|
|
|
|
|
|
|
sprintf(adapter->name, "viafb i2c io_port idx 0x%02x",
|
|
|
|
adap_cfg->ioport_index);
|
|
|
|
adapter->owner = THIS_MODULE;
|
|
|
|
adapter->id = 0x01FFFF;
|
|
|
|
adapter->class = I2C_CLASS_DDC;
|
|
|
|
adapter->algo_data = algo;
|
|
|
|
if (pdev)
|
|
|
|
adapter->dev.parent = &pdev->dev;
|
|
|
|
else
|
|
|
|
adapter->dev.parent = NULL;
|
|
|
|
/* i2c_set_adapdata(adapter, adap_cfg); */
|
2008-10-16 05:03:29 +00:00
|
|
|
|
|
|
|
/* Raise SCL and SDA */
|
2009-05-22 16:35:39 +00:00
|
|
|
via_i2c_setsda(adap_cfg, 1);
|
|
|
|
via_i2c_setscl(adap_cfg, 1);
|
2008-10-16 05:03:29 +00:00
|
|
|
udelay(20);
|
|
|
|
|
2009-05-22 16:35:39 +00:00
|
|
|
return i2c_bit_add_bus(adapter);
|
|
|
|
}
|
|
|
|
|
2009-12-02 03:29:39 +00:00
|
|
|
int viafb_create_i2c_busses(struct via_port_cfg *configs)
|
2009-05-22 16:35:39 +00:00
|
|
|
{
|
|
|
|
int i, ret;
|
|
|
|
|
2009-12-02 03:29:39 +00:00
|
|
|
for (i = 0; i < VIAFB_NUM_PORTS; i++) {
|
|
|
|
struct via_port_cfg *adap_cfg = configs++;
|
|
|
|
struct via_i2c_stuff *i2c_stuff = &via_i2c_par[i];
|
2009-05-22 16:35:39 +00:00
|
|
|
|
2009-12-02 03:29:39 +00:00
|
|
|
if (adap_cfg->type == 0 || adap_cfg->mode != VIA_MODE_I2C)
|
2010-04-25 14:30:41 +00:00
|
|
|
continue;
|
2009-05-22 16:35:39 +00:00
|
|
|
|
|
|
|
ret = create_i2c_bus(&i2c_stuff->adapter,
|
|
|
|
&i2c_stuff->algo, adap_cfg,
|
|
|
|
NULL); /* FIXME: PCIDEV */
|
|
|
|
if (ret < 0) {
|
|
|
|
printk(KERN_ERR "viafb: cannot create i2c bus %u:%d\n",
|
|
|
|
i, ret);
|
|
|
|
/* FIXME: properly release previous busses */
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|
|
|
|
|
2009-12-02 03:29:39 +00:00
|
|
|
void viafb_delete_i2c_busses(void)
|
2008-10-16 05:03:29 +00:00
|
|
|
{
|
2009-05-22 16:35:39 +00:00
|
|
|
int i;
|
|
|
|
|
2009-12-02 03:29:39 +00:00
|
|
|
for (i = 0; i < VIAFB_NUM_PORTS; i++) {
|
|
|
|
struct via_i2c_stuff *i2c_stuff = &via_i2c_par[i];
|
|
|
|
/*
|
|
|
|
* Only remove those entries in the array that we've
|
|
|
|
* actually used (and thus initialized algo_data)
|
|
|
|
*/
|
2009-05-22 16:35:39 +00:00
|
|
|
if (i2c_stuff->adapter.algo_data == &i2c_stuff->algo)
|
|
|
|
i2c_del_adapter(&i2c_stuff->adapter);
|
|
|
|
}
|
2008-10-16 05:03:29 +00:00
|
|
|
}
|