diff options
author | Florian Fainelli <florian@openwrt.org> | 2008-09-01 11:49:57 +0000 |
---|---|---|
committer | Florian Fainelli <florian@openwrt.org> | 2008-09-01 11:49:57 +0000 |
commit | 5721055e5cf5f34c242e99d5f2f32d1a6ed0a844 (patch) | |
tree | f8e5e3c3e2d8cf60c265b7b501717995777da4a9 /target/linux/ar7/files/drivers | |
parent | a0881502d5ebd471e416f42ff5b23d34b80a7643 (diff) | |
download | upstream-5721055e5cf5f34c242e99d5f2f32d1a6ed0a844.tar.gz upstream-5721055e5cf5f34c242e99d5f2f32d1a6ed0a844.tar.bz2 upstream-5721055e5cf5f34c242e99d5f2f32d1a6ed0a844.zip |
Fix divisor calculation and configuration from previous commit, thanks sn9
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@12454 3c298f89-4303-0410-b956-a3cf2f4a3e73
Diffstat (limited to 'target/linux/ar7/files/drivers')
-rw-r--r-- | target/linux/ar7/files/drivers/vlynq/vlynq.c | 53 |
1 files changed, 16 insertions, 37 deletions
diff --git a/target/linux/ar7/files/drivers/vlynq/vlynq.c b/target/linux/ar7/files/drivers/vlynq/vlynq.c index 1de5789b7c..14022b1fb2 100644 --- a/target/linux/ar7/files/drivers/vlynq/vlynq.c +++ b/target/linux/ar7/files/drivers/vlynq/vlynq.c @@ -26,6 +26,7 @@ #include <linux/platform_device.h> #include <linux/interrupt.h> #include <linux/device.h> +#include <linux/delay.h> #include <linux/io.h> #include <linux/vlynq.h> @@ -301,39 +302,19 @@ static int vlynq_device_match(struct device *dev, { struct vlynq_device *vdev = to_vlynq_device(dev); struct vlynq_driver *vdrv = to_vlynq_driver(drv); - struct plat_vlynq_ops *ops = dev->platform_data; struct vlynq_device_id *ids = vdrv->id_table; - u32 id = 0; - int result, flag; while (ids->id) { - flag = 0; - if (ids->divisor != vlynq_div_auto - && vdev->divisor == vlynq_div_auto) { - flag = 1; + if (ids->id == vdev->dev_id) { vdev->divisor = ids->divisor; - result = __vlynq_enable_device(vdev); - if (result == 0) { - id = vlynq_reg_read(vdev->remote->chip); - vlynq_reg_write(vdev->local->control, 0); - vlynq_reg_write(vdev->remote->control, 0); - ops->off(vdev); - } else - id = vdev->dev_id; - } else - id = vdev->dev_id; - if (ids->id == id) { - vdev->dev_id = id; vlynq_set_drvdata(vdev, ids); printk(KERN_INFO "Driver found for VLYNQ " \ - "device: %08x\n", id); + "device: %08x\n", vdev->dev_id); return 1; } - printk(KERN_INFO "Not using the %08x VLYNQ device's " \ - "driver for VLYNQ device: %08x\n", ids->id, id); + printk(KERN_DEBUG "Not using the %08x VLYNQ device's driver" \ + " for VLYNQ device: %08x\n", ids->id, vdev->dev_id); ids++; - if (flag) - vdev->divisor = vlynq_div_auto; } return 0; } @@ -385,20 +366,20 @@ static int __vlynq_enable_device(struct vlynq_device *dev) if (result) return result; - vlynq_reg_write(dev->local->control, 0); - vlynq_reg_write(dev->remote->control, 0); - if (vlynq_linked(dev)) { - printk(KERN_DEBUG "%s: using external clock\n", - dev->dev.bus_id); - return 0; - } - switch (dev->divisor) { case vlynq_div_auto: /* Only try locally supplied clock, others cause problems */ vlynq_reg_write(dev->local->control, 0); vlynq_reg_write(dev->remote->control, 0); - for (i = vlynq_ldiv2; i <= vlynq_ldiv8; i++) { + if (vlynq_linked(dev)) { + dev->divisor = vlynq_div_external; + printk(KERN_DEBUG "%s: using external clock\n", + dev->dev.bus_id); + return 0; + } + for (i = dev->dev_id ? vlynq_ldiv2 : vlynq_ldiv8; dev->dev_id ? + i <= vlynq_ldiv8 : i >= vlynq_ldiv2; + dev->dev_id ? i++ : i--) { vlynq_reg_write(dev->local->control, VLYNQ_CTRL_CLOCK_INT | VLYNQ_CTRL_CLOCK_DIV(i - vlynq_ldiv1)); @@ -618,15 +599,13 @@ static int vlynq_probe(struct platform_device *pdev) dev->dev.bus_id, (void *)dev->regs_start, dev->irq, (void *)dev->mem_start); + dev->dev_id = 0; dev->divisor = vlynq_div_auto; result = __vlynq_enable_device(dev); if (result == 0) { dev->dev_id = vlynq_reg_read(dev->remote->chip); - vlynq_reg_write(dev->local->control, 0); - vlynq_reg_write(dev->remote->control, 0); ((struct plat_vlynq_ops *)(dev->dev.platform_data))->off(dev); - } else - dev->dev_id = 0; + } if (dev->dev_id) printk(KERN_INFO "Found a VLYNQ device: %08x\n", dev->dev_id); |