cregit-Linux how code gets into the kernel

Release 4.11 drivers/video/fbdev/via/via_i2c.c

/*
 * Copyright 1998-2009 VIA Technologies, Inc. All Rights Reserved.
 * 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 <linux/platform_device.h>
#include <linux/delay.h>
#include <linux/spinlock.h>
#include <linux/module.h>
#include <linux/via-core.h>
#include <linux/via_i2c.h>

/*
 * 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];

static struct viafb_dev *i2c_vdev;  
/* Passed in from core */


static void via_i2c_setscl(void *data, int state) { u8 val; struct via_port_cfg *adap_data = data; unsigned long flags; spin_lock_irqsave(&i2c_vdev->reg_lock, flags); val = via_read_reg(adap_data->io_port, adap_data->ioport_index) & 0xF0; if (state) val |= 0x20; else val &= ~0x20; switch (adap_data->type) { case VIA_PORT_I2C: val |= 0x01; break; case VIA_PORT_GPIO: val |= 0x82; break; default: printk(KERN_ERR "viafb_i2c: specify wrong i2c type.\n"); } via_write_reg(adap_data->io_port, adap_data->ioport_index, val); spin_unlock_irqrestore(&i2c_vdev->reg_lock, flags); }

Contributors

PersonTokensPropCommitsCommitProp
Joseph Chan7461.67%116.67%
Jonathan Corbet3327.50%350.00%
Harald Welte1210.00%116.67%
Florian Tobias Schandinat10.83%116.67%
Total120100.00%6100.00%


static int via_i2c_getscl(void *data) { struct via_port_cfg *adap_data = data; unsigned long flags; int ret = 0; spin_lock_irqsave(&i2c_vdev->reg_lock, flags); if (adap_data->type == VIA_PORT_GPIO) via_write_reg_mask(adap_data->io_port, adap_data->ioport_index, 0, 0x80); if (via_read_reg(adap_data->io_port, adap_data->ioport_index) & 0x08) ret = 1; spin_unlock_irqrestore(&i2c_vdev->reg_lock, flags); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Jonathan Corbet3538.46%240.00%
Joseph Chan2729.67%120.00%
Florian Tobias Schandinat2325.27%120.00%
Harald Welte66.59%120.00%
Total91100.00%5100.00%


static int via_i2c_getsda(void *data) { struct via_port_cfg *adap_data = data; unsigned long flags; int ret = 0; spin_lock_irqsave(&i2c_vdev->reg_lock, flags); if (adap_data->type == VIA_PORT_GPIO) via_write_reg_mask(adap_data->io_port, adap_data->ioport_index, 0, 0x40); if (via_read_reg(adap_data->io_port, adap_data->ioport_index) & 0x04) ret = 1; spin_unlock_irqrestore(&i2c_vdev->reg_lock, flags); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Jonathan Corbet3538.46%240.00%
Joseph Chan2729.67%120.00%
Florian Tobias Schandinat2325.27%120.00%
Harald Welte66.59%120.00%
Total91100.00%5100.00%


static void via_i2c_setsda(void *data, int state) { u8 val; struct via_port_cfg *adap_data = data; unsigned long flags; spin_lock_irqsave(&i2c_vdev->reg_lock, flags); val = via_read_reg(adap_data->io_port, adap_data->ioport_index) & 0xF0; if (state) val |= 0x10; else val &= ~0x10; switch (adap_data->type) { case VIA_PORT_I2C: val |= 0x01; break; case VIA_PORT_GPIO: val |= 0x42; break; default: printk(KERN_ERR "viafb_i2c: specify wrong i2c type.\n"); } via_write_reg(adap_data->io_port, adap_data->ioport_index, val); spin_unlock_irqrestore(&i2c_vdev->reg_lock, flags); }

Contributors

PersonTokensPropCommitsCommitProp
Joseph Chan7461.67%116.67%
Jonathan Corbet3327.50%350.00%
Harald Welte1210.00%116.67%
Florian Tobias Schandinat10.83%116.67%
Total120100.00%6100.00%


int viafb_i2c_readbyte(u8 adap, u8 slave_addr, u8 index, u8 *pdata) { int ret; u8 mm1[] = {0x00}; struct i2c_msg msgs[2]; if (!via_i2c_par[adap].is_active) return -ENODEV; *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; ret = i2c_transfer(&via_i2c_par[adap].adapter, msgs, 2); if (ret == 2) ret = 0; else if (ret >= 0) ret = -EIO; return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Joseph Chan12571.02%120.00%
Florian Tobias Schandinat3017.05%120.00%
Jonathan Corbet158.52%240.00%
Harald Welte63.41%120.00%
Total176100.00%5100.00%


int viafb_i2c_writebyte(u8 adap, u8 slave_addr, u8 index, u8 data) { int ret; u8 msg[2] = { index, data }; struct i2c_msg msgs; if (!via_i2c_par[adap].is_active) return -ENODEV; msgs.flags = 0; msgs.addr = slave_addr / 2; msgs.len = 2; msgs.buf = msg; ret = i2c_transfer(&via_i2c_par[adap].adapter, &msgs, 1); if (ret == 1) ret = 0; else if (ret >= 0) ret = -EIO; return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Joseph Chan6857.14%120.00%
Florian Tobias Schandinat3025.21%120.00%
Jonathan Corbet1512.61%240.00%
Harald Welte65.04%120.00%
Total119100.00%5100.00%


int viafb_i2c_readbytes(u8 adap, u8 slave_addr, u8 index, u8 *buff, int buff_len) { int ret; u8 mm1[] = {0x00}; struct i2c_msg msgs[2]; if (!via_i2c_par[adap].is_active) return -ENODEV; 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; ret = i2c_transfer(&via_i2c_par[adap].adapter, msgs, 2); if (ret == 2) ret = 0; else if (ret >= 0) ret = -EIO; return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Joseph Chan12370.69%120.00%
Florian Tobias Schandinat3017.24%120.00%
Jonathan Corbet158.62%240.00%
Harald Welte63.45%120.00%
Total174100.00%5100.00%

/* * Allow other viafb subdevices to look up a specific adapter * by port name. */
struct i2c_adapter *viafb_find_i2c_adapter(enum viafb_i2c_adap which) { struct via_i2c_stuff *stuff = &via_i2c_par[which]; return &stuff->adapter; }

Contributors

PersonTokensPropCommitsCommitProp
Jonathan Corbet28100.00%1100.00%
Total28100.00%1100.00%

EXPORT_SYMBOL_GPL(viafb_find_i2c_adapter);
static int create_i2c_bus(struct i2c_adapter *adapter, struct i2c_algo_bit_data *algo, struct via_port_cfg *adap_cfg, struct pci_dev *pdev) { algo->setsda = via_i2c_setsda; algo->setscl = via_i2c_setscl; algo->getsda = via_i2c_getsda; algo->getscl = via_i2c_getscl; algo->udelay = 10; algo->timeout = 2; algo->data = adap_cfg; sprintf(adapter->name, "viafb i2c io_port idx 0x%02x", adap_cfg->ioport_index); adapter->owner = THIS_MODULE; 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); */ /* Raise SCL and SDA */ via_i2c_setsda(adap_cfg, 1); via_i2c_setscl(adap_cfg, 1); udelay(20); return i2c_bit_add_bus(adapter); }

Contributors

PersonTokensPropCommitsCommitProp
Harald Welte7852.00%120.00%
Joseph Chan6644.00%120.00%
Florian Tobias Schandinat53.33%240.00%
Jonathan Corbet10.67%120.00%
Total150100.00%5100.00%


static int viafb_i2c_probe(struct platform_device *platdev) { int i, ret; struct via_port_cfg *configs; i2c_vdev = platdev->dev.platform_data; configs = i2c_vdev->port_cfg; 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]; i2c_stuff->is_active = 0; if (adap_cfg->type == 0 || adap_cfg->mode != VIA_MODE_I2C) continue; 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); continue; /* Still try to make the rest */ } i2c_stuff->is_active = 1; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Harald Welte7352.52%112.50%
Jonathan Corbet5035.97%562.50%
Joseph Chan1510.79%112.50%
Florian Tobias Schandinat10.72%112.50%
Total139100.00%8100.00%


static int viafb_i2c_remove(struct platform_device *platdev) { int i; 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) */ if (i2c_stuff->is_active) i2c_del_adapter(&i2c_stuff->adapter); } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Harald Welte3560.34%120.00%
Jonathan Corbet1525.86%360.00%
Joseph Chan813.79%120.00%
Total58100.00%5100.00%

static struct platform_driver via_i2c_driver = { .driver = { .name = "viafb-i2c", }, .probe = viafb_i2c_probe, .remove = viafb_i2c_remove, };
int viafb_i2c_init(void) { return platform_driver_register(&via_i2c_driver); }

Contributors

PersonTokensPropCommitsCommitProp
Jonathan Corbet14100.00%1100.00%
Total14100.00%1100.00%


void viafb_i2c_exit(void) { platform_driver_unregister(&via_i2c_driver); }

Contributors

PersonTokensPropCommitsCommitProp
Jonathan Corbet1292.31%150.00%
Harald Welte17.69%150.00%
Total13100.00%2100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Joseph Chan60944.62%15.88%
Jonathan Corbet36927.03%1058.82%
Harald Welte24217.73%15.88%
Florian Tobias Schandinat14410.55%423.53%
Stephen Hemminger10.07%15.88%
Total1365100.00%17100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.