mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-12 13:55:32 +00:00
mtd: maps: Merge gpio-addr-flash.c into physmap-core.c
Controlling some MSB address lines using GPIOs is just a small deviation from the generic physmap logic, and merging those two drivers allows us to share most of the probe logic, which is a good thing. Also, the gpio-addr-flash driver is unused since the removal of the blackfin arch in v4.17, so we can safely remove the old driver without risking breaking existing boards. Signed-off-by: Boris Brezillon <boris.brezillon@bootlin.com> Reviewed-by: Ricardo Ribalda Delgado <ricardo.ribalda@gmail.com> Tested-by: Ricardo Ribalda Delgado <ricardo.ribalda@gmail.com> Acked-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
parent
3edf4b9f38
commit
ba32ce95cb
4 changed files with 157 additions and 294 deletions
|
@ -94,6 +94,15 @@ config MTD_PHYSMAP_GEMINI
|
||||||
platforms, some detection and setting up parallel mode on the
|
platforms, some detection and setting up parallel mode on the
|
||||||
external interface.
|
external interface.
|
||||||
|
|
||||||
|
config MTD_PHYSMAP_GPIO_ADDR
|
||||||
|
bool "GPIO-assisted Flash Chip Support"
|
||||||
|
depends on MTD_PHYSMAP
|
||||||
|
depends on GPIOLIB || COMPILE_TEST
|
||||||
|
depends on MTD_COMPLEX_MAPPINGS
|
||||||
|
help
|
||||||
|
Extend the physmap driver to allow flashes to be partially
|
||||||
|
physically addressed and assisted by GPIOs.
|
||||||
|
|
||||||
config MTD_PMC_MSP_EVM
|
config MTD_PMC_MSP_EVM
|
||||||
tristate "CFI Flash device mapped on PMC-Sierra MSP"
|
tristate "CFI Flash device mapped on PMC-Sierra MSP"
|
||||||
depends on PMC_MSP && MTD_CFI
|
depends on PMC_MSP && MTD_CFI
|
||||||
|
@ -334,16 +343,6 @@ config MTD_PCMCIA_ANONYMOUS
|
||||||
|
|
||||||
If unsure, say N.
|
If unsure, say N.
|
||||||
|
|
||||||
config MTD_GPIO_ADDR
|
|
||||||
tristate "GPIO-assisted Flash Chip Support"
|
|
||||||
depends on GPIOLIB || COMPILE_TEST
|
|
||||||
depends on MTD_COMPLEX_MAPPINGS
|
|
||||||
help
|
|
||||||
Map driver which allows flashes to be partially physically addressed
|
|
||||||
and assisted by GPIOs.
|
|
||||||
|
|
||||||
If compiled as a module, it will be called gpio-addr-flash.
|
|
||||||
|
|
||||||
config MTD_UCLINUX
|
config MTD_UCLINUX
|
||||||
bool "Generic uClinux RAM/ROM filesystem support"
|
bool "Generic uClinux RAM/ROM filesystem support"
|
||||||
depends on (MTD_RAM=y || MTD_ROM=y) && (!MMU || COLDFIRE)
|
depends on (MTD_RAM=y || MTD_ROM=y) && (!MMU || COLDFIRE)
|
||||||
|
|
|
@ -43,6 +43,5 @@ obj-$(CONFIG_MTD_PLATRAM) += plat-ram.o
|
||||||
obj-$(CONFIG_MTD_INTEL_VR_NOR) += intel_vr_nor.o
|
obj-$(CONFIG_MTD_INTEL_VR_NOR) += intel_vr_nor.o
|
||||||
obj-$(CONFIG_MTD_RBTX4939) += rbtx4939-flash.o
|
obj-$(CONFIG_MTD_RBTX4939) += rbtx4939-flash.o
|
||||||
obj-$(CONFIG_MTD_VMU) += vmu-flash.o
|
obj-$(CONFIG_MTD_VMU) += vmu-flash.o
|
||||||
obj-$(CONFIG_MTD_GPIO_ADDR) += gpio-addr-flash.o
|
|
||||||
obj-$(CONFIG_MTD_LATCH_ADDR) += latch-addr-flash.o
|
obj-$(CONFIG_MTD_LATCH_ADDR) += latch-addr-flash.o
|
||||||
obj-$(CONFIG_MTD_LANTIQ) += lantiq-flash.o
|
obj-$(CONFIG_MTD_LANTIQ) += lantiq-flash.o
|
||||||
|
|
|
@ -1,281 +0,0 @@
|
||||||
/*
|
|
||||||
* drivers/mtd/maps/gpio-addr-flash.c
|
|
||||||
*
|
|
||||||
* Handle the case where a flash device is mostly addressed using physical
|
|
||||||
* line and supplemented by GPIOs. This way you can hook up say a 8MiB flash
|
|
||||||
* to a 2MiB memory range and use the GPIOs to select a particular range.
|
|
||||||
*
|
|
||||||
* Copyright © 2000 Nicolas Pitre <nico@cam.org>
|
|
||||||
* Copyright © 2005-2009 Analog Devices Inc.
|
|
||||||
*
|
|
||||||
* Enter bugs at http://blackfin.uclinux.org/
|
|
||||||
*
|
|
||||||
* Licensed under the GPL-2 or later.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <linux/gpio.h>
|
|
||||||
#include <linux/gpio/consumer.h>
|
|
||||||
#include <linux/io.h>
|
|
||||||
#include <linux/kernel.h>
|
|
||||||
#include <linux/module.h>
|
|
||||||
#include <linux/mtd/mtd.h>
|
|
||||||
#include <linux/mtd/map.h>
|
|
||||||
#include <linux/mtd/partitions.h>
|
|
||||||
#include <linux/mtd/physmap.h>
|
|
||||||
#include <linux/platform_device.h>
|
|
||||||
#include <linux/slab.h>
|
|
||||||
#include <linux/types.h>
|
|
||||||
|
|
||||||
#define win_mask(x) ((BIT(x)) - 1)
|
|
||||||
|
|
||||||
#define DRIVER_NAME "gpio-addr-flash"
|
|
||||||
|
|
||||||
/**
|
|
||||||
* struct async_state - keep GPIO flash state
|
|
||||||
* @mtd: MTD state for this mapping
|
|
||||||
* @map: MTD map state for this flash
|
|
||||||
* @gpios: Struct containing the array of GPIO descriptors
|
|
||||||
* @gpio_values: cached GPIO values
|
|
||||||
* @win_order: dedicated memory size (if no GPIOs)
|
|
||||||
*/
|
|
||||||
struct async_state {
|
|
||||||
struct mtd_info *mtd;
|
|
||||||
struct map_info map;
|
|
||||||
struct gpio_descs *gpios;
|
|
||||||
unsigned int gpio_values;
|
|
||||||
unsigned int win_order;
|
|
||||||
};
|
|
||||||
#define gf_map_info_to_state(mi) ((struct async_state *)(mi)->map_priv_1)
|
|
||||||
|
|
||||||
/**
|
|
||||||
* gf_set_gpios() - set GPIO address lines to access specified flash offset
|
|
||||||
* @state: GPIO flash state
|
|
||||||
* @ofs: desired offset to access
|
|
||||||
*
|
|
||||||
* Rather than call the GPIO framework every time, cache the last-programmed
|
|
||||||
* value. This speeds up sequential accesses (which are by far the most common
|
|
||||||
* type).
|
|
||||||
*/
|
|
||||||
static void gf_set_gpios(struct async_state *state, unsigned long ofs)
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
|
|
||||||
ofs >>= state->win_order;
|
|
||||||
|
|
||||||
if (ofs == state->gpio_values)
|
|
||||||
return;
|
|
||||||
|
|
||||||
for (i = 0; i < state->gpios->ndescs; i++) {
|
|
||||||
if ((ofs & BIT(i)) == (state->gpio_values & BIT(i)))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
gpiod_set_value(state->gpios->desc[i], !!(ofs & BIT(i)));
|
|
||||||
}
|
|
||||||
|
|
||||||
state->gpio_values = ofs;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* gf_read() - read a word at the specified offset
|
|
||||||
* @map: MTD map state
|
|
||||||
* @ofs: desired offset to read
|
|
||||||
*/
|
|
||||||
static map_word gf_read(struct map_info *map, unsigned long ofs)
|
|
||||||
{
|
|
||||||
struct async_state *state = gf_map_info_to_state(map);
|
|
||||||
uint16_t word;
|
|
||||||
map_word test;
|
|
||||||
|
|
||||||
gf_set_gpios(state, ofs);
|
|
||||||
|
|
||||||
word = readw(map->virt + (ofs & win_mask(state->win_order)));
|
|
||||||
test.x[0] = word;
|
|
||||||
return test;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* gf_copy_from() - copy a chunk of data from the flash
|
|
||||||
* @map: MTD map state
|
|
||||||
* @to: memory to copy to
|
|
||||||
* @from: flash offset to copy from
|
|
||||||
* @len: how much to copy
|
|
||||||
*
|
|
||||||
* The "from" region may straddle more than one window, so toggle the GPIOs for
|
|
||||||
* each window region before reading its data.
|
|
||||||
*/
|
|
||||||
static void gf_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
|
|
||||||
{
|
|
||||||
struct async_state *state = gf_map_info_to_state(map);
|
|
||||||
|
|
||||||
int this_len;
|
|
||||||
|
|
||||||
while (len) {
|
|
||||||
this_len = from & win_mask(state->win_order);
|
|
||||||
this_len = BIT(state->win_order) - this_len;
|
|
||||||
this_len = min_t(int, len, this_len);
|
|
||||||
|
|
||||||
gf_set_gpios(state, from);
|
|
||||||
memcpy_fromio(to,
|
|
||||||
map->virt + (from & win_mask(state->win_order)),
|
|
||||||
this_len);
|
|
||||||
len -= this_len;
|
|
||||||
from += this_len;
|
|
||||||
to += this_len;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* gf_write() - write a word at the specified offset
|
|
||||||
* @map: MTD map state
|
|
||||||
* @ofs: desired offset to write
|
|
||||||
*/
|
|
||||||
static void gf_write(struct map_info *map, map_word d1, unsigned long ofs)
|
|
||||||
{
|
|
||||||
struct async_state *state = gf_map_info_to_state(map);
|
|
||||||
uint16_t d;
|
|
||||||
|
|
||||||
gf_set_gpios(state, ofs);
|
|
||||||
|
|
||||||
d = d1.x[0];
|
|
||||||
writew(d, map->virt + (ofs & win_mask(state->win_order)));
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* gf_copy_to() - copy a chunk of data to the flash
|
|
||||||
* @map: MTD map state
|
|
||||||
* @to: flash offset to copy to
|
|
||||||
* @from: memory to copy from
|
|
||||||
* @len: how much to copy
|
|
||||||
*
|
|
||||||
* See gf_copy_from() caveat.
|
|
||||||
*/
|
|
||||||
static void gf_copy_to(struct map_info *map, unsigned long to,
|
|
||||||
const void *from, ssize_t len)
|
|
||||||
{
|
|
||||||
struct async_state *state = gf_map_info_to_state(map);
|
|
||||||
|
|
||||||
int this_len;
|
|
||||||
|
|
||||||
while (len) {
|
|
||||||
this_len = to & win_mask(state->win_order);
|
|
||||||
this_len = BIT(state->win_order) - this_len;
|
|
||||||
this_len = min_t(int, len, this_len);
|
|
||||||
|
|
||||||
gf_set_gpios(state, to);
|
|
||||||
memcpy_toio(map->virt + (to & win_mask(state->win_order)),
|
|
||||||
from, len);
|
|
||||||
|
|
||||||
len -= this_len;
|
|
||||||
to += this_len;
|
|
||||||
from += this_len;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static const char * const part_probe_types[] = {
|
|
||||||
"cmdlinepart", "RedBoot", NULL };
|
|
||||||
|
|
||||||
/**
|
|
||||||
* gpio_flash_probe() - setup a mapping for a GPIO assisted flash
|
|
||||||
* @pdev: platform device
|
|
||||||
*
|
|
||||||
* The platform resource layout expected looks something like:
|
|
||||||
* struct mtd_partition partitions[] = { ... };
|
|
||||||
* struct physmap_flash_data flash_data = { ... };
|
|
||||||
* static struct gpiod_lookup_table addr_flash_gpios = {
|
|
||||||
* .dev_id = "gpio-addr-flash.0",
|
|
||||||
* .table = {
|
|
||||||
* GPIO_LOOKUP_IDX("gpio.0", 15, "addr", 0, GPIO_ACTIVE_HIGH),
|
|
||||||
* GPIO_LOOKUP_IDX("gpio.0", 16, "addr", 1, GPIO_ACTIVE_HIGH),
|
|
||||||
* );
|
|
||||||
* };
|
|
||||||
* gpiod_add_lookup_table(&addr_flash_gpios);
|
|
||||||
*
|
|
||||||
* struct resource flash_resource[] = {
|
|
||||||
* {
|
|
||||||
* .name = "cfi_probe",
|
|
||||||
* .start = 0x20000000,
|
|
||||||
* .end = 0x201fffff,
|
|
||||||
* .flags = IORESOURCE_MEM,
|
|
||||||
* },
|
|
||||||
* };
|
|
||||||
* struct platform_device flash_device = {
|
|
||||||
* .name = "gpio-addr-flash",
|
|
||||||
* .dev = { .platform_data = &flash_data, },
|
|
||||||
* .num_resources = ARRAY_SIZE(flash_resource),
|
|
||||||
* .resource = flash_resource,
|
|
||||||
* ...
|
|
||||||
* };
|
|
||||||
*/
|
|
||||||
static int gpio_flash_probe(struct platform_device *pdev)
|
|
||||||
{
|
|
||||||
struct physmap_flash_data *pdata;
|
|
||||||
struct resource *memory;
|
|
||||||
struct async_state *state;
|
|
||||||
|
|
||||||
pdata = dev_get_platdata(&pdev->dev);
|
|
||||||
memory = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
||||||
|
|
||||||
if (!memory)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
state = devm_kzalloc(&pdev->dev, sizeof(*state), GFP_KERNEL);
|
|
||||||
if (!state)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
state->gpios = devm_gpiod_get_array(&pdev->dev, "addr", GPIOD_OUT_LOW);
|
|
||||||
if (IS_ERR(state->gpios))
|
|
||||||
return PTR_ERR(state->gpios);
|
|
||||||
|
|
||||||
state->win_order = get_bitmask_order(resource_size(memory)) - 1;
|
|
||||||
|
|
||||||
state->map.name = DRIVER_NAME;
|
|
||||||
state->map.read = gf_read;
|
|
||||||
state->map.copy_from = gf_copy_from;
|
|
||||||
state->map.write = gf_write;
|
|
||||||
state->map.copy_to = gf_copy_to;
|
|
||||||
state->map.bankwidth = pdata->width;
|
|
||||||
state->map.size = BIT(state->win_order + state->gpios->ndescs);
|
|
||||||
state->map.virt = devm_ioremap_resource(&pdev->dev, memory);
|
|
||||||
if (IS_ERR(state->map.virt))
|
|
||||||
return PTR_ERR(state->map.virt);
|
|
||||||
|
|
||||||
state->map.phys = NO_XIP;
|
|
||||||
state->map.map_priv_1 = (unsigned long)state;
|
|
||||||
|
|
||||||
platform_set_drvdata(pdev, state);
|
|
||||||
|
|
||||||
dev_notice(&pdev->dev, "probing %d-bit flash bus\n",
|
|
||||||
state->map.bankwidth * 8);
|
|
||||||
state->mtd = do_map_probe(memory->name, &state->map);
|
|
||||||
if (!state->mtd)
|
|
||||||
return -ENXIO;
|
|
||||||
state->mtd->dev.parent = &pdev->dev;
|
|
||||||
|
|
||||||
mtd_device_parse_register(state->mtd, part_probe_types, NULL,
|
|
||||||
pdata->parts, pdata->nr_parts);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int gpio_flash_remove(struct platform_device *pdev)
|
|
||||||
{
|
|
||||||
struct async_state *state = platform_get_drvdata(pdev);
|
|
||||||
|
|
||||||
mtd_device_unregister(state->mtd);
|
|
||||||
map_destroy(state->mtd);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct platform_driver gpio_flash_driver = {
|
|
||||||
.probe = gpio_flash_probe,
|
|
||||||
.remove = gpio_flash_remove,
|
|
||||||
.driver = {
|
|
||||||
.name = DRIVER_NAME,
|
|
||||||
},
|
|
||||||
};
|
|
||||||
|
|
||||||
module_platform_driver(gpio_flash_driver);
|
|
||||||
|
|
||||||
MODULE_AUTHOR("Mike Frysinger <vapier@gentoo.org>");
|
|
||||||
MODULE_DESCRIPTION("MTD map driver for flashes addressed physically and with gpios");
|
|
||||||
MODULE_LICENSE("GPL");
|
|
|
@ -13,6 +13,14 @@
|
||||||
*
|
*
|
||||||
* Revised to handle newer style flash binding by:
|
* Revised to handle newer style flash binding by:
|
||||||
* Copyright (C) 2007 David Gibson, IBM Corporation.
|
* Copyright (C) 2007 David Gibson, IBM Corporation.
|
||||||
|
*
|
||||||
|
* GPIO address extension:
|
||||||
|
* Handle the case where a flash device is mostly addressed using physical
|
||||||
|
* line and supplemented by GPIOs. This way you can hook up say a 8MiB flash
|
||||||
|
* to a 2MiB memory range and use the GPIOs to select a particular range.
|
||||||
|
*
|
||||||
|
* Copyright © 2000 Nicolas Pitre <nico@cam.org>
|
||||||
|
* Copyright © 2005-2009 Analog Devices Inc.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
|
@ -30,6 +38,7 @@
|
||||||
#include <linux/mtd/cfi_endian.h>
|
#include <linux/mtd/cfi_endian.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
#include <linux/of_device.h>
|
#include <linux/of_device.h>
|
||||||
|
#include <linux/gpio/consumer.h>
|
||||||
|
|
||||||
#include "physmap-gemini.h"
|
#include "physmap-gemini.h"
|
||||||
#include "physmap-versatile.h"
|
#include "physmap-versatile.h"
|
||||||
|
@ -45,6 +54,9 @@ struct physmap_flash_info {
|
||||||
const char * const *part_types;
|
const char * const *part_types;
|
||||||
unsigned int nparts;
|
unsigned int nparts;
|
||||||
const struct mtd_partition *parts;
|
const struct mtd_partition *parts;
|
||||||
|
struct gpio_descs *gpios;
|
||||||
|
unsigned int gpio_values;
|
||||||
|
unsigned int win_order;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int physmap_flash_remove(struct platform_device *dev)
|
static int physmap_flash_remove(struct platform_device *dev)
|
||||||
|
@ -104,6 +116,119 @@ static void physmap_set_vpp(struct map_info *map, int state)
|
||||||
spin_unlock_irqrestore(&info->vpp_lock, flags);
|
spin_unlock_irqrestore(&info->vpp_lock, flags);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_MTD_PHYSMAP_GPIO_ADDR)
|
||||||
|
static void physmap_set_addr_gpios(struct physmap_flash_info *info,
|
||||||
|
unsigned long ofs)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
ofs >>= info->win_order;
|
||||||
|
if (info->gpio_values == ofs)
|
||||||
|
return;
|
||||||
|
|
||||||
|
for (i = 0; i < info->gpios->ndescs; i++) {
|
||||||
|
if ((BIT(i) & ofs) == (BIT(i) & info->gpio_values))
|
||||||
|
continue;
|
||||||
|
|
||||||
|
gpiod_set_value(info->gpios->desc[i], !!(BIT(i) & ofs));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#define win_mask(order) (BIT(order) - 1)
|
||||||
|
|
||||||
|
static map_word physmap_addr_gpios_read(struct map_info *map,
|
||||||
|
unsigned long ofs)
|
||||||
|
{
|
||||||
|
struct platform_device *pdev;
|
||||||
|
struct physmap_flash_info *info;
|
||||||
|
map_word mw;
|
||||||
|
u16 word;
|
||||||
|
|
||||||
|
pdev = (struct platform_device *)map->map_priv_1;
|
||||||
|
info = platform_get_drvdata(pdev);
|
||||||
|
physmap_set_addr_gpios(info, ofs);
|
||||||
|
|
||||||
|
word = readw(map->virt + (ofs & win_mask(info->win_order)));
|
||||||
|
mw.x[0] = word;
|
||||||
|
return mw;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void physmap_addr_gpios_copy_from(struct map_info *map, void *buf,
|
||||||
|
unsigned long ofs, ssize_t len)
|
||||||
|
{
|
||||||
|
struct platform_device *pdev;
|
||||||
|
struct physmap_flash_info *info;
|
||||||
|
|
||||||
|
pdev = (struct platform_device *)map->map_priv_1;
|
||||||
|
info = platform_get_drvdata(pdev);
|
||||||
|
|
||||||
|
while (len) {
|
||||||
|
unsigned int winofs = ofs & win_mask(info->win_order);
|
||||||
|
unsigned int chunklen = min_t(unsigned int, len,
|
||||||
|
BIT(info->win_order) - winofs);
|
||||||
|
|
||||||
|
physmap_set_addr_gpios(info, ofs);
|
||||||
|
memcpy_fromio(buf, map->virt + winofs, chunklen);
|
||||||
|
len -= chunklen;
|
||||||
|
buf += chunklen;
|
||||||
|
ofs += chunklen;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void physmap_addr_gpios_write(struct map_info *map, map_word mw,
|
||||||
|
unsigned long ofs)
|
||||||
|
{
|
||||||
|
struct platform_device *pdev;
|
||||||
|
struct physmap_flash_info *info;
|
||||||
|
u16 word;
|
||||||
|
|
||||||
|
pdev = (struct platform_device *)map->map_priv_1;
|
||||||
|
info = platform_get_drvdata(pdev);
|
||||||
|
physmap_set_addr_gpios(info, ofs);
|
||||||
|
|
||||||
|
word = mw.x[0];
|
||||||
|
writew(word, map->virt + (ofs & win_mask(info->win_order)));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void physmap_addr_gpios_copy_to(struct map_info *map, unsigned long ofs,
|
||||||
|
const void *buf, ssize_t len)
|
||||||
|
{
|
||||||
|
struct platform_device *pdev;
|
||||||
|
struct physmap_flash_info *info;
|
||||||
|
|
||||||
|
pdev = (struct platform_device *)map->map_priv_1;
|
||||||
|
info = platform_get_drvdata(pdev);
|
||||||
|
|
||||||
|
while (len) {
|
||||||
|
unsigned int winofs = ofs & win_mask(info->win_order);
|
||||||
|
unsigned int chunklen = min_t(unsigned int, len,
|
||||||
|
BIT(info->win_order) - winofs);
|
||||||
|
|
||||||
|
physmap_set_addr_gpios(info, ofs);
|
||||||
|
memcpy_toio(map->virt + winofs, buf, chunklen);
|
||||||
|
len -= chunklen;
|
||||||
|
buf += chunklen;
|
||||||
|
ofs += chunklen;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int physmap_addr_gpios_map_init(struct map_info *map)
|
||||||
|
{
|
||||||
|
map->phys = NO_XIP;
|
||||||
|
map->read = physmap_addr_gpios_read;
|
||||||
|
map->copy_from = physmap_addr_gpios_copy_from;
|
||||||
|
map->write = physmap_addr_gpios_write;
|
||||||
|
map->copy_to = physmap_addr_gpios_copy_to;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
static int physmap_addr_gpios_map_init(struct map_info *map)
|
||||||
|
{
|
||||||
|
return -ENOTSUPP;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
#if IS_ENABLED(CONFIG_MTD_PHYSMAP_OF)
|
#if IS_ENABLED(CONFIG_MTD_PHYSMAP_OF)
|
||||||
static const struct of_device_id of_flash_match[] = {
|
static const struct of_device_id of_flash_match[] = {
|
||||||
{
|
{
|
||||||
|
@ -343,6 +468,16 @@ static int physmap_flash_probe(struct platform_device *dev)
|
||||||
|
|
||||||
platform_set_drvdata(dev, info);
|
platform_set_drvdata(dev, info);
|
||||||
|
|
||||||
|
info->gpios = devm_gpiod_get_array_optional(&dev->dev, "addr",
|
||||||
|
GPIOD_OUT_LOW);
|
||||||
|
if (IS_ERR(info->gpios))
|
||||||
|
return PTR_ERR(info->gpios);
|
||||||
|
|
||||||
|
if (info->gpios && info->nmaps > 1) {
|
||||||
|
dev_err(&dev->dev, "addr-gpios only supported for nmaps == 1\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
if (dev->dev.of_node)
|
if (dev->dev.of_node)
|
||||||
err = physmap_flash_of_init(dev);
|
err = physmap_flash_of_init(dev);
|
||||||
else
|
else
|
||||||
|
@ -369,10 +504,20 @@ static int physmap_flash_probe(struct platform_device *dev)
|
||||||
if (!info->maps[i].phys)
|
if (!info->maps[i].phys)
|
||||||
info->maps[i].phys = res->start;
|
info->maps[i].phys = res->start;
|
||||||
|
|
||||||
info->maps[i].size = resource_size(res);
|
info->win_order = get_bitmask_order(resource_size(res)) - 1;
|
||||||
|
info->maps[i].size = BIT(info->win_order +
|
||||||
|
(info->gpios ?
|
||||||
|
info->gpios->ndescs : 0));
|
||||||
|
|
||||||
info->maps[i].map_priv_1 = (unsigned long)dev;
|
info->maps[i].map_priv_1 = (unsigned long)dev;
|
||||||
|
|
||||||
simple_map_init(&info->maps[i]);
|
if (info->gpios) {
|
||||||
|
err = physmap_addr_gpios_map_init(&info->maps[i]);
|
||||||
|
if (err)
|
||||||
|
goto err_out;
|
||||||
|
} else {
|
||||||
|
simple_map_init(&info->maps[i]);
|
||||||
|
}
|
||||||
|
|
||||||
probe_type = rom_probe_types;
|
probe_type = rom_probe_types;
|
||||||
if (!info->probe_type) {
|
if (!info->probe_type) {
|
||||||
|
@ -497,6 +642,7 @@ module_exit(physmap_exit);
|
||||||
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
||||||
MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
|
MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
|
||||||
MODULE_AUTHOR("Vitaly Wool <vwool@ru.mvista.com>");
|
MODULE_AUTHOR("Vitaly Wool <vwool@ru.mvista.com>");
|
||||||
|
MODULE_AUTHOR("Mike Frysinger <vapier@gentoo.org>");
|
||||||
MODULE_DESCRIPTION("Generic configurable MTD map driver");
|
MODULE_DESCRIPTION("Generic configurable MTD map driver");
|
||||||
|
|
||||||
/* legacy platform drivers can't hotplug or coldplg */
|
/* legacy platform drivers can't hotplug or coldplg */
|
||||||
|
|
Loading…
Reference in a new issue