Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 193563
b: refs/heads/master
c: 7582eb9
h: refs/heads/master
i:
  193561: ef705fa
  193559: 5d08daf
v: v3
  • Loading branch information
Jonathan Corbet committed May 7, 2010
1 parent c4cfd26 commit 15aa5fa
Show file tree
Hide file tree
Showing 7 changed files with 141 additions and 42 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 75b035ace904761b8a340b524533a36e37313b29
refs/heads/master: 7582eb9be85f35271fd2569681a88a5b243e9380
91 changes: 75 additions & 16 deletions trunk/drivers/video/via/via-core.c
Original file line number Diff line number Diff line change
Expand Up @@ -190,6 +190,70 @@ static void __devexit via_pci_teardown_mmio(struct viafb_dev *vdev)
iounmap(vdev->engine_mmio);
}

/*
* Create our subsidiary devices.
*/
static struct viafb_subdev_info {
char *name;
struct platform_device *platdev;
} viafb_subdevs[] = {
{
.name = "viafb-gpio",
},
{
.name = "viafb-i2c",
}
};
#define N_SUBDEVS ARRAY_SIZE(viafb_subdevs)

static int __devinit via_create_subdev(struct viafb_dev *vdev,
struct viafb_subdev_info *info)
{
int ret;

info->platdev = platform_device_alloc(info->name, -1);
if (!info->platdev) {
dev_err(&vdev->pdev->dev, "Unable to allocate pdev %s\n",
info->name);
return -ENOMEM;
}
info->platdev->dev.parent = &vdev->pdev->dev;
info->platdev->dev.platform_data = vdev;
ret = platform_device_add(info->platdev);
if (ret) {
dev_err(&vdev->pdev->dev, "Unable to add pdev %s\n",
info->name);
platform_device_put(info->platdev);
info->platdev = NULL;
}
return ret;
}

static int __devinit via_setup_subdevs(struct viafb_dev *vdev)
{
int i;

/*
* Ignore return values. Even if some of the devices
* fail to be created, we'll still be able to use some
* of the rest.
*/
for (i = 0; i < N_SUBDEVS; i++)
via_create_subdev(vdev, viafb_subdevs + i);
return 0;
}

static void __devexit via_teardown_subdevs(void)
{
int i;

for (i = 0; i < N_SUBDEVS; i++)
if (viafb_subdevs[i].platdev) {
viafb_subdevs[i].platdev->dev.platform_data = NULL;
platform_device_unregister(viafb_subdevs[i].platdev);
}
}


static int __devinit via_pci_probe(struct pci_dev *pdev,
const struct pci_device_id *ent)
Expand All @@ -205,33 +269,25 @@ static int __devinit via_pci_probe(struct pci_dev *pdev,
memset(&global_dev, 0, sizeof(global_dev));
global_dev.pdev = pdev;
global_dev.chip_type = ent->driver_data;
global_dev.port_cfg = adap_configs;
spin_lock_init(&global_dev.reg_lock);
ret = via_pci_setup_mmio(&global_dev);
if (ret)
goto out_disable;
/*
* Create the I2C busses. Bailing out on failure seems extreme,
* but that's what the code did before.
* Create our subdevices. Continue even if some things fail.
*/
ret = viafb_create_i2c_busses(&global_dev, adap_configs);
if (ret)
goto out_teardown;
via_setup_subdevs(&global_dev);
/*
* Set up the framebuffer.
*/
ret = via_fb_pci_probe(&global_dev);
if (ret)
goto out_i2c;
/*
* Create the GPIOs. We continue whether or not this succeeds;
* the framebuffer might be useful even without GPIO ports.
*/
ret = viafb_create_gpios(&global_dev, adap_configs);
goto out_subdevs;
return 0;

out_i2c:
viafb_delete_i2c_busses();
out_teardown:
out_subdevs:
via_teardown_subdevs();
via_pci_teardown_mmio(&global_dev);
out_disable:
pci_disable_device(pdev);
Expand All @@ -240,8 +296,7 @@ static int __devinit via_pci_probe(struct pci_dev *pdev,

static void __devexit via_pci_remove(struct pci_dev *pdev)
{
viafb_destroy_gpios();
viafb_delete_i2c_busses();
via_teardown_subdevs();
via_fb_pci_remove(pdev);
via_pci_teardown_mmio(&global_dev);
pci_disable_device(pdev);
Expand Down Expand Up @@ -289,12 +344,16 @@ static int __init via_core_init(void)
ret = viafb_init();
if (ret)
return ret;
viafb_i2c_init();
viafb_gpio_init();
return pci_register_driver(&via_driver);
}

static void __exit via_core_exit(void)
{
pci_unregister_driver(&via_driver);
viafb_gpio_exit();
viafb_i2c_exit();
viafb_exit();
}

Expand Down
1 change: 1 addition & 0 deletions trunk/drivers/video/via/via-core.h
Original file line number Diff line number Diff line change
Expand Up @@ -63,6 +63,7 @@ struct via_port_cfg {
struct viafb_dev {
struct pci_dev *pdev;
int chip_type;
struct via_port_cfg *port_cfg;
/*
* Spinlock for access to device registers. Not yet
* globally used.
Expand Down
49 changes: 34 additions & 15 deletions trunk/drivers/video/via/via-gpio.c
Original file line number Diff line number Diff line change
Expand Up @@ -7,6 +7,7 @@

#include <linux/spinlock.h>
#include <linux/gpio.h>
#include <linux/platform_device.h>
#include "via-core.h"
#include "via-gpio.h"
#include "global.h"
Expand Down Expand Up @@ -172,12 +173,27 @@ static void viafb_gpio_disable(struct viafb_gpio *gpio)
via_write_reg_mask(VIASR, gpio->vg_port_index, 0, 0x02);
}

/*
* Look up a specific gpio and return the number it was assigned.
*/
int viafb_gpio_lookup(const char *name)
{
int i;

for (i = 0; i < gpio_config.gpio_chip.ngpio; i++)
if (!strcmp(name, gpio_config.active_gpios[i]->vg_name))
return gpio_config.gpio_chip.base + i;
return -1;
}
EXPORT_SYMBOL_GPL(viafb_gpio_lookup);


int viafb_create_gpios(struct viafb_dev *vdev,
const struct via_port_cfg *port_cfg)
/*
* Platform device stuff.
*/
static __devinit int viafb_gpio_probe(struct platform_device *platdev)
{
struct viafb_dev *vdev = platdev->dev.platform_data;
struct via_port_cfg *port_cfg = vdev->port_cfg;
int i, ngpio = 0, ret;
struct viafb_gpio *gpio;
unsigned long flags;
Expand Down Expand Up @@ -222,11 +238,10 @@ int viafb_create_gpios(struct viafb_dev *vdev,
gpio_config.gpio_chip.ngpio = 0;
}
return ret;
/* Port enable ? */
}


int viafb_destroy_gpios(void)
static int viafb_gpio_remove(struct platform_device *platdev)
{
unsigned long flags;
int ret = 0, i;
Expand All @@ -253,16 +268,20 @@ int viafb_destroy_gpios(void)
return ret;
}

/*
* Look up a specific gpio and return the number it was assigned.
*/
int viafb_gpio_lookup(const char *name)
static struct platform_driver via_gpio_driver = {
.driver = {
.name = "viafb-gpio",
},
.probe = viafb_gpio_probe,
.remove = viafb_gpio_remove,
};

int viafb_gpio_init(void)
{
int i;
return platform_driver_register(&via_gpio_driver);
}

for (i = 0; i < gpio_config.gpio_chip.ngpio; i++)
if (!strcmp(name, gpio_config.active_gpios[i]->vg_name))
return gpio_config.gpio_chip.base + i;
return -1;
void viafb_gpio_exit(void)
{
platform_driver_unregister(&via_gpio_driver);
}
EXPORT_SYMBOL_GPL(viafb_gpio_lookup);
5 changes: 2 additions & 3 deletions trunk/drivers/video/via/via-gpio.h
Original file line number Diff line number Diff line change
Expand Up @@ -8,8 +8,7 @@
#ifndef __VIA_GPIO_H__
#define __VIA_GPIO_H__

extern int viafb_create_gpios(struct viafb_dev *vdev,
const struct via_port_cfg *port_cfg);
extern int viafb_destroy_gpios(void);
extern int viafb_gpio_lookup(const char *name);
extern int viafb_gpio_init(void);
extern void viafb_gpio_exit(void);
#endif
29 changes: 26 additions & 3 deletions trunk/drivers/video/via/via_i2c.c
Original file line number Diff line number Diff line change
Expand Up @@ -19,6 +19,7 @@
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
*/

#include <linux/platform_device.h>
#include "via-core.h"
#include "via_i2c.h"
#include "global.h"
Expand Down Expand Up @@ -185,11 +186,14 @@ static int create_i2c_bus(struct i2c_adapter *adapter,
return i2c_bit_add_bus(adapter);
}

int viafb_create_i2c_busses(struct viafb_dev *dev, struct via_port_cfg *configs)
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;

i2c_vdev = dev;
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];
Expand All @@ -211,7 +215,7 @@ int viafb_create_i2c_busses(struct viafb_dev *dev, struct via_port_cfg *configs)
return 0;
}

void viafb_delete_i2c_busses(void)
static int viafb_i2c_remove(struct platform_device *platdev)
{
int i;

Expand All @@ -224,4 +228,23 @@ void viafb_delete_i2c_busses(void)
if (i2c_stuff->adapter.algo_data == &i2c_stuff->algo)
i2c_del_adapter(&i2c_stuff->adapter);
}
return 0;
}

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);
}

void viafb_i2c_exit(void)
{
platform_driver_unregister(&via_i2c_driver);
}
6 changes: 2 additions & 4 deletions trunk/drivers/video/via/via_i2c.h
Original file line number Diff line number Diff line change
Expand Up @@ -35,8 +35,6 @@ int viafb_i2c_readbyte(u8 adap, u8 slave_addr, u8 index, u8 *pdata);
int viafb_i2c_writebyte(u8 adap, u8 slave_addr, u8 index, u8 data);
int viafb_i2c_readbytes(u8 adap, u8 slave_addr, u8 index, u8 *buff, int buff_len);

struct viafb_par;
int viafb_create_i2c_busses(struct viafb_dev *vdev, struct via_port_cfg *cfg);
void viafb_delete_i2c_busses(void);
struct i2c_adapter *viafb_find_adapter(enum viafb_i2c_adap which);
extern int viafb_i2c_init(void);
extern void viafb_i2c_exit(void);
#endif /* __VIA_I2C_H__ */

0 comments on commit 15aa5fa

Please sign in to comment.