X-Git-Url: http://git.rohieb.name/openwrt.git/blobdiff_plain/6c0eb0af8cd8cd6ad04ea26b5ebbf2bbac576fac..23d61f22e9a68a7873626df4a01c60794f1acb7a:/target/linux/adm5120/files/drivers/mtd/maps/adm5120-flash.c?ds=sidebyside

diff --git a/target/linux/adm5120/files/drivers/mtd/maps/adm5120-flash.c b/target/linux/adm5120/files/drivers/mtd/maps/adm5120-flash.c
index 7a55396e7..b84492f46 100644
--- a/target/linux/adm5120/files/drivers/mtd/maps/adm5120-flash.c
+++ b/target/linux/adm5120/files/drivers/mtd/maps/adm5120-flash.c
@@ -32,15 +32,14 @@
 #include <linux/kernel.h>
 #include <linux/init.h>
 #include <linux/slab.h>
+#include <linux/io.h>
 #include <linux/device.h>
-
 #include <linux/platform_device.h>
+
 #include <linux/mtd/mtd.h>
 #include <linux/mtd/map.h>
 #include <linux/mtd/partitions.h>
 
-#include <asm/io.h>
-
 #include <adm5120_defs.h>
 #include <adm5120_switch.h>
 #include <adm5120_mpmc.h>
@@ -173,7 +172,7 @@ static void adm5120_flash_write(struct map_info *map, const map_word datum,
 {
 	struct adm5120_map_info *amap = map_to_amap(map);
 
-	MAP_DBG(map,"writing to ofs %lX\n", ofs);
+	MAP_DBG(map, "writing to ofs %lX\n", ofs);
 
 	if (ofs > amap->window_size)
 		return;
@@ -221,14 +220,15 @@ static int adm5120_flash_initres(struct adm5120_flash_info *info)
 	struct map_info *map = &info->amap.map;
 	int err = 0;
 
-	info->res = request_mem_region(map->phys, map->size, map->name);
+	info->res = request_mem_region(map->phys, info->amap.window_size,
+			map->name);
 	if (info->res == NULL) {
 		MAP_ERR(map, "could not reserve memory region\n");
 		err = -ENOMEM;
 		goto out;
 	}
 
-	map->virt = ioremap_nocache(map->phys, map->size);
+	map->virt = ioremap_nocache(map->phys, info->amap.window_size);
 	if (map->virt == NULL) {
 		MAP_ERR(map, "failed to ioremap flash region\n");
 		err = -ENOMEM;
@@ -245,7 +245,7 @@ static int adm5120_flash_initinfo(struct adm5120_flash_info *info,
 	struct map_info *map = &info->amap.map;
 	struct adm5120_flash_platform_data *pdata = dev->dev.platform_data;
 	struct flash_desc *fdesc;
-	u32 t;
+	u32 t = 0;
 
 	map->name = dev->dev.bus_id;
 
@@ -256,12 +256,18 @@ static int adm5120_flash_initinfo(struct adm5120_flash_info *info,
 
 	fdesc = &flash_descs[dev->id];
 
-	/* get memory window size */
-	t = SW_READ_REG(MEMCTRL) >> fdesc->srs_shift;
-	t &= MEMCTRL_SRS_MASK;
-	info->amap.window_size = flash_sizes[t];
+	if (pdata)
+		info->amap.window_size = pdata->window_size;
+
+	if (info->amap.window_size == 0) {
+		/* get memory window size */
+		t = SW_READ_REG(SWITCH_REG_MEMCTRL) >> fdesc->srs_shift;
+		t &= MEMCTRL_SRS_MASK;
+		info->amap.window_size = flash_sizes[t];
+	}
+
 	if (info->amap.window_size == 0) {
-		MAP_ERR(map, "invalid flash size detected\n");
+		MAP_ERR(map, "unable to determine window size\n");
 		goto err_out;
 	}
 
@@ -329,7 +335,7 @@ static void adm5120_flash_initbanks(struct adm5120_flash_info *info)
 #ifdef CONFIG_MTD_PARTITIONS
 static int adm5120_flash_initparts(struct adm5120_flash_info *info)
 {
-	struct adm5120_flash_platform_data *pdata = info->dev->dev.platform_data;
+	struct adm5120_flash_platform_data *pdata;
 	struct map_info *map = &info->amap.map;
 	int num_parsers;
 	const char *parser[2];
@@ -339,6 +345,7 @@ static int adm5120_flash_initparts(struct adm5120_flash_info *info)
 
 	info->nr_parts = 0;
 
+	pdata = info->dev->dev.platform_data;
 	if (pdata == NULL)
 		goto out;
 
@@ -357,7 +364,7 @@ static int adm5120_flash_initparts(struct adm5120_flash_info *info)
 		num_parsers = MAX_PARSED_PARTS;
 
 	parser[1] = NULL;
-	for (i=0; i<num_parsers; i++) {
+	for (i = 0; i < num_parsers; i++) {
 		parser[0] = parse_types[i];
 
 		MAP_INFO(map, "parsing \"%s\" partitions\n",
@@ -394,7 +401,7 @@ static void adm5120_flash_remove_mtd(struct adm5120_flash_info *info)
 
 	if (info->nr_parts) {
 		del_mtd_partitions(info->mtd);
-		for (i=0; i<MAX_PARSED_PARTS; i++)
+		for (i = 0; i < MAX_PARSED_PARTS; i++)
 			if (info->parts[i] != NULL)
 				kfree(info->parts[i]);
 	} else {
@@ -496,7 +503,8 @@ static int adm5120_flash_probe(struct platform_device *dev)
 		goto err_out;
 
 	if (info->nr_parts == 0) {
-		MAP_INFO(map, "no partitions available, registering whole flash\n");
+		MAP_INFO(map, "no partitions available, registering "
+			"whole flash\n");
 		add_mtd_device(info->mtd);
 	}
 
@@ -508,7 +516,8 @@ err_out:
 }
 
 #ifdef CONFIG_PM
-static int adm5120_flash_suspend(struct platform_device *dev, pm_message_t state)
+static int adm5120_flash_suspend(struct platform_device *dev,
+		pm_message_t state)
 {
 	struct adm5120_flash_info *info = platform_get_drvdata(dev);
 	int ret = 0;