Orange Pi5 kernel

/*
 * Mapping of a custom board with both AMD CFI and JEDEC flash in partitions.
 * Config with both CFI and JEDEC device support.
 *
 * Basically physmap.c with the addition of partitions and
 * an array of mapping info to accommodate more than one flash type per board.
 *
 * Copyright 2005-2007 PMC-Sierra, Inc.
 *
 *  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 the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
 *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
 *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
 *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
 *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
 *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *  You should have received a copy of the  GNU General Public License along
 *  with this program; if not, write  to the Free Software Foundation, Inc.,
 *  675 Mass Ave, Cambridge, MA 02139, USA.
 */
 
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/map.h>
#include <linux/mtd/partitions.h>
 
#include <asm/io.h>
 
#include <msp_prom.h>
#include <msp_regs.h>
 
 
static struct mtd_info **msp_flash;
static struct mtd_partition **msp_parts;
static struct map_info *msp_maps;
static int fcnt;
 
#define DEBUG_MARKER printk(KERN_NOTICE "%s[%d]\n", __func__, __LINE__)
 
static int __init init_msp_flash(void)
{
<------>int i, j, ret = -ENOMEM;
<------>int offset, coff;
<------>char *env;
<------>int pcnt;
<------>char flash_name[] = "flash0";
<------>char part_name[] = "flash0_0";
<------>unsigned addr, size;
 
<------>/* If ELB is disabled by "ful-mux" mode, we can't get at flash */
<------>if ((*DEV_ID_REG & DEV_ID_SINGLE_PC) &&
<------>    (*ELB_1PC_EN_REG & SINGLE_PCCARD)) {
<------><------>printk(KERN_NOTICE "Single PC Card mode: no flash access\n");
<------><------>return -ENXIO;
<------>}
 
<------>/* examine the prom environment for flash devices */
<------>for (fcnt = 0; (env = prom_getenv(flash_name)); fcnt++)
<------><------>flash_name[5] = '0' + fcnt + 1;
 
<------>if (fcnt < 1)
<------><------>return -ENXIO;
 
<------>printk(KERN_NOTICE "Found %d PMC flash devices\n", fcnt);
 
<------>msp_flash = kcalloc(fcnt, sizeof(*msp_flash), GFP_KERNEL);
<------>if (!msp_flash)
<------><------>return -ENOMEM;
 
<------>msp_parts = kcalloc(fcnt, sizeof(*msp_parts), GFP_KERNEL);
<------>if (!msp_parts)
<------><------>goto free_msp_flash;
 
<------>msp_maps = kcalloc(fcnt, sizeof(*msp_maps), GFP_KERNEL);
<------>if (!msp_maps)
<------><------>goto free_msp_parts;
 
<------>/* loop over the flash devices, initializing each */
<------>for (i = 0; i < fcnt; i++) {
<------><------>/* examine the prom environment for flash partititions */
<------><------>part_name[5] = '0' + i;
<------><------>part_name[7] = '0';
<------><------>for (pcnt = 0; (env = prom_getenv(part_name)); pcnt++)
<------><------><------>part_name[7] = '0' + pcnt + 1;
 
<------><------>if (pcnt == 0) {
<------><------><------>printk(KERN_NOTICE "Skipping flash device %d "
<------><------><------><------>"(no partitions defined)\n", i);
<------><------><------>continue;
<------><------>}
 
<------><------>msp_parts[i] = kcalloc(pcnt, sizeof(struct mtd_partition),
<------><------><------><------>       GFP_KERNEL);
<------><------>if (!msp_parts[i])
<------><------><------>goto cleanup_loop;
 
<------><------>/* now initialize the devices proper */
<------><------>flash_name[5] = '0' + i;
<------><------>env = prom_getenv(flash_name);
 
<------><------>if (sscanf(env, "%x:%x", &addr, &size) < 2) {
<------><------><------>ret = -ENXIO;
<------><------><------>kfree(msp_parts[i]);
<------><------><------>goto cleanup_loop;
<------><------>}
<------><------>addr = CPHYSADDR(addr);
 
<------><------>printk(KERN_NOTICE
<------><------><------>"MSP flash device \"%s\": 0x%08x at 0x%08x\n",
<------><------><------>flash_name, size, addr);
<------><------>/* This must matchs the actual size of the flash chip */
<------><------>msp_maps[i].size = size;
<------><------>msp_maps[i].phys = addr;
 
<------><------>/*
<------><------> * Platforms have a specific limit of the size of memory
<------><------> * which may be mapped for flash:
<------><------> */
<------><------>if (size > CONFIG_MSP_FLASH_MAP_LIMIT)
<------><------><------>size = CONFIG_MSP_FLASH_MAP_LIMIT;
 
<------><------>msp_maps[i].virt = ioremap(addr, size);
<------><------>if (msp_maps[i].virt == NULL) {
<------><------><------>ret = -ENXIO;
<------><------><------>kfree(msp_parts[i]);
<------><------><------>goto cleanup_loop;
<------><------>}
 
<------><------>msp_maps[i].bankwidth = 1;
<------><------>msp_maps[i].name = kstrndup(flash_name, 7, GFP_KERNEL);
<------><------>if (!msp_maps[i].name) {
<------><------><------>iounmap(msp_maps[i].virt);
<------><------><------>kfree(msp_parts[i]);
<------><------><------>goto cleanup_loop;
<------><------>}
 
<------><------>for (j = 0; j < pcnt; j++) {
<------><------><------>part_name[5] = '0' + i;
<------><------><------>part_name[7] = '0' + j;
 
<------><------><------>env = prom_getenv(part_name);
 
<------><------><------>if (sscanf(env, "%x:%x:%n", &offset, &size,
<------><------><------><------><------><------>&coff) < 2) {
<------><------><------><------>ret = -ENXIO;
<------><------><------><------>kfree(msp_maps[i].name);
<------><------><------><------>iounmap(msp_maps[i].virt);
<------><------><------><------>kfree(msp_parts[i]);
<------><------><------><------>goto cleanup_loop;
<------><------><------>}
 
<------><------><------>msp_parts[i][j].size = size;
<------><------><------>msp_parts[i][j].offset = offset;
<------><------><------>msp_parts[i][j].name = env + coff;
<------><------>}
 
<------><------>/* now probe and add the device */
<------><------>simple_map_init(&msp_maps[i]);
<------><------>msp_flash[i] = do_map_probe("cfi_probe", &msp_maps[i]);
<------><------>if (msp_flash[i]) {
<------><------><------>msp_flash[i]->owner = THIS_MODULE;
<------><------><------>mtd_device_register(msp_flash[i], msp_parts[i], pcnt);
<------><------>} else {
<------><------><------>printk(KERN_ERR "map probe failed for flash\n");
<------><------><------>ret = -ENXIO;
<------><------><------>kfree(msp_maps[i].name);
<------><------><------>iounmap(msp_maps[i].virt);
<------><------><------>kfree(msp_parts[i]);
<------><------><------>goto cleanup_loop;
<------><------>}
<------>}
 
<------>return 0;
 
cleanup_loop:
<------>while (i--) {
<------><------>mtd_device_unregister(msp_flash[i]);
<------><------>map_destroy(msp_flash[i]);
<------><------>kfree(msp_maps[i].name);
<------><------>iounmap(msp_maps[i].virt);
<------><------>kfree(msp_parts[i]);
<------>}
<------>kfree(msp_maps);
free_msp_parts:
<------>kfree(msp_parts);
free_msp_flash:
<------>kfree(msp_flash);
<------>return ret;
}
 
static void __exit cleanup_msp_flash(void)
{
<------>int i;
 
<------>for (i = 0; i < fcnt; i++) {
<------><------>mtd_device_unregister(msp_flash[i]);
<------><------>map_destroy(msp_flash[i]);
<------><------>iounmap((void *)msp_maps[i].virt);
 
<------><------>/* free the memory */
<------><------>kfree(msp_maps[i].name);
<------><------>kfree(msp_parts[i]);
<------>}
 
<------>kfree(msp_flash);
<------>kfree(msp_parts);
<------>kfree(msp_maps);
}
 
MODULE_AUTHOR("PMC-Sierra, Inc");
MODULE_DESCRIPTION("MTD map driver for PMC-Sierra MSP boards");
MODULE_LICENSE("GPL");
 
module_init(init_msp_flash);
module_exit(cleanup_msp_flash);