X-Git-Url: http://git.rohieb.name/openwrt.git/blobdiff_plain/1927554d27d885595be87bf3ffeecf8dad5feb65..2e6d4b3f153ffaad9c24d955f31704e52af65b90:/target/linux/ar7/files/drivers/vlynq/vlynq.c

diff --git a/target/linux/ar7/files/drivers/vlynq/vlynq.c b/target/linux/ar7/files/drivers/vlynq/vlynq.c
index c2ac536ba..25f303bf1 100644
--- a/target/linux/ar7/files/drivers/vlynq/vlynq.c
+++ b/target/linux/ar7/files/drivers/vlynq/vlynq.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (C) 2006, 2007 OpenWrt.org
+ * Copyright (C) 2006, 2007 Eugene Konev <ejka@openwrt.org>
  *
  * 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
@@ -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>
@@ -68,7 +69,7 @@ struct vlynq_regs {
 	u32 autonego;
 	u32 unused[6];
 	u32 int_device[8];
-} __attribute__ ((packed));
+};
 
 #define vlynq_reg_read(reg) readl(&(reg))
 #define vlynq_reg_write(reg, val)  writel(val, &(reg))
@@ -301,22 +302,18 @@ 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;
 
 	while (ids->id) {
-		vdev->divisor = ids->divisor;
-		result = __vlynq_enable_device(vdev);
-		if (result == 0) {
-			id = vlynq_reg_read(vdev->remote->chip);
-			ops->off(vdev);
-			if (ids->id == id) {
-				vlynq_set_drvdata(vdev, ids);
-				return 1;
-			}
+		if (ids->id == vdev->dev_id) {
+			vdev->divisor = ids->divisor;
+			vlynq_set_drvdata(vdev, ids);
+			printk(KERN_INFO "Driver found for VLYNQ " \
+				"device: %08x\n", vdev->dev_id);
+			return 1;
 		}
+		printk(KERN_DEBUG "Not using the %08x VLYNQ device's driver" \
+			" for VLYNQ device: %08x\n", ids->id, vdev->dev_id);
 		ids++;
 	}
 	return 0;
@@ -369,19 +366,22 @@ 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_external:
 	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;
+		}
+
+		/* Only try locally supplied clock, others cause problems */
+		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));
@@ -395,11 +395,11 @@ static int __vlynq_enable_device(struct vlynq_device *dev)
 		}
 	case vlynq_ldiv1: case vlynq_ldiv2: case vlynq_ldiv3: case vlynq_ldiv4:
 	case vlynq_ldiv5: case vlynq_ldiv6: case vlynq_ldiv7: case vlynq_ldiv8:
-		vlynq_reg_write(dev->remote->control, 0);
 		vlynq_reg_write(dev->local->control,
 				VLYNQ_CTRL_CLOCK_INT |
 				VLYNQ_CTRL_CLOCK_DIV(dev->divisor -
 						     vlynq_ldiv1));
+		vlynq_reg_write(dev->remote->control, 0);
 		if (vlynq_linked(dev)) {
 			printk(KERN_DEBUG
 			       "%s: using local clock divisor %d\n",
@@ -601,6 +601,16 @@ 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);
+		((struct plat_vlynq_ops *)(dev->dev.platform_data))->off(dev);
+	}
+	if (dev->dev_id)
+		printk(KERN_INFO "Found a VLYNQ device: %08x\n", dev->dev_id);
+
 	return 0;
 
 fail_register:
@@ -625,7 +635,7 @@ static int vlynq_remove(struct platform_device *pdev)
 	return 0;
 }
 
-static struct platform_driver vlynq_driver = {
+static struct platform_driver vlynq_platform_driver = {
 	.driver.name = "vlynq",
 	.probe = vlynq_probe,
 	.remove = __devexit_p(vlynq_remove),
@@ -647,7 +657,7 @@ static int __devinit vlynq_init(void)
 	if (res)
 		goto fail_bus;
 
-	res = platform_driver_register(&vlynq_driver);
+	res = platform_driver_register(&vlynq_platform_driver);
 	if (res)
 		goto fail_platform;
 
@@ -661,7 +671,7 @@ fail_bus:
 
 static void __devexit vlynq_exit(void)
 {
-	platform_driver_unregister(&vlynq_driver);
+	platform_driver_unregister(&vlynq_platform_driver);
 	bus_unregister(&vlynq_bus_type);
 }