![Jamie Iles](/assets/img/avatar_default.png)
The older add_mtd_device()/add_mtd_partitions() and their removal counterparts will soon be gone. Replace uses with mtd_device_register() and mtd_device_unregister(). Signed-off-by: Jamie Iles <jamie@jamieiles.com> Signed-off-by: Artem Bityutskiy <Artem.Bityutskiy@nokia.com> Signed-off-by: David Woodhouse <David.Woodhouse@intel.com>
497 lines
13 KiB
C
497 lines
13 KiB
C
/* dilnetpc.c -- MTD map driver for SSV DIL/Net PC Boards "DNP" and "ADNP"
|
|
*
|
|
* 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 program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA
|
|
*
|
|
* The DIL/Net PC is a tiny embedded PC board made by SSV Embedded Systems
|
|
* featuring the AMD Elan SC410 processor. There are two variants of this
|
|
* board: DNP/1486 and ADNP/1486. The DNP version has 2 megs of flash
|
|
* ROM (Intel 28F016S3) and 8 megs of DRAM, the ADNP version has 4 megs
|
|
* flash and 16 megs of RAM.
|
|
* For details, see http://www.ssv-embedded.de/ssv/pc104/p169.htm
|
|
* and http://www.ssv-embedded.de/ssv/pc104/p170.htm
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/mtd/mtd.h>
|
|
#include <linux/mtd/map.h>
|
|
#include <linux/mtd/partitions.h>
|
|
#include <linux/mtd/concat.h>
|
|
|
|
#include <asm/io.h>
|
|
|
|
/*
|
|
** The DIL/NetPC keeps its BIOS in two distinct flash blocks.
|
|
** Destroying any of these blocks transforms the DNPC into
|
|
** a paperweight (albeit not a very useful one, considering
|
|
** it only weighs a few grams).
|
|
**
|
|
** Therefore, the BIOS blocks must never be erased or written to
|
|
** except by people who know exactly what they are doing (e.g.
|
|
** to install a BIOS update). These partitions are marked read-only
|
|
** by default, but can be made read/write by undefining
|
|
** DNPC_BIOS_BLOCKS_WRITEPROTECTED:
|
|
*/
|
|
#define DNPC_BIOS_BLOCKS_WRITEPROTECTED
|
|
|
|
/*
|
|
** The ID string (in ROM) is checked to determine whether we
|
|
** are running on a DNP/1486 or ADNP/1486
|
|
*/
|
|
#define BIOSID_BASE 0x000fe100
|
|
|
|
#define ID_DNPC "DNP1486"
|
|
#define ID_ADNP "ADNP1486"
|
|
|
|
/*
|
|
** Address where the flash should appear in CPU space
|
|
*/
|
|
#define FLASH_BASE 0x2000000
|
|
|
|
/*
|
|
** Chip Setup and Control (CSC) indexed register space
|
|
*/
|
|
#define CSC_INDEX 0x22
|
|
#define CSC_DATA 0x23
|
|
|
|
#define CSC_MMSWAR 0x30 /* MMS window C-F attributes register */
|
|
#define CSC_MMSWDSR 0x31 /* MMS window C-F device select register */
|
|
|
|
#define CSC_RBWR 0xa7 /* GPIO Read-Back/Write Register B */
|
|
|
|
#define CSC_CR 0xd0 /* internal I/O device disable/Echo */
|
|
/* Z-bus/configuration register */
|
|
|
|
#define CSC_PCCMDCR 0xf1 /* PC card mode and DMA control register */
|
|
|
|
|
|
/*
|
|
** PC Card indexed register space:
|
|
*/
|
|
|
|
#define PCC_INDEX 0x3e0
|
|
#define PCC_DATA 0x3e1
|
|
|
|
#define PCC_AWER_B 0x46 /* Socket B Address Window enable register */
|
|
#define PCC_MWSAR_1_Lo 0x58 /* memory window 1 start address low register */
|
|
#define PCC_MWSAR_1_Hi 0x59 /* memory window 1 start address high register */
|
|
#define PCC_MWEAR_1_Lo 0x5A /* memory window 1 stop address low register */
|
|
#define PCC_MWEAR_1_Hi 0x5B /* memory window 1 stop address high register */
|
|
#define PCC_MWAOR_1_Lo 0x5C /* memory window 1 address offset low register */
|
|
#define PCC_MWAOR_1_Hi 0x5D /* memory window 1 address offset high register */
|
|
|
|
|
|
/*
|
|
** Access to SC4x0's Chip Setup and Control (CSC)
|
|
** and PC Card (PCC) indexed registers:
|
|
*/
|
|
static inline void setcsc(int reg, unsigned char data)
|
|
{
|
|
outb(reg, CSC_INDEX);
|
|
outb(data, CSC_DATA);
|
|
}
|
|
|
|
static inline unsigned char getcsc(int reg)
|
|
{
|
|
outb(reg, CSC_INDEX);
|
|
return(inb(CSC_DATA));
|
|
}
|
|
|
|
static inline void setpcc(int reg, unsigned char data)
|
|
{
|
|
outb(reg, PCC_INDEX);
|
|
outb(data, PCC_DATA);
|
|
}
|
|
|
|
static inline unsigned char getpcc(int reg)
|
|
{
|
|
outb(reg, PCC_INDEX);
|
|
return(inb(PCC_DATA));
|
|
}
|
|
|
|
|
|
/*
|
|
************************************************************
|
|
** Enable access to DIL/NetPC's flash by mapping it into
|
|
** the SC4x0's MMS Window C.
|
|
************************************************************
|
|
*/
|
|
static void dnpc_map_flash(unsigned long flash_base, unsigned long flash_size)
|
|
{
|
|
unsigned long flash_end = flash_base + flash_size - 1;
|
|
|
|
/*
|
|
** enable setup of MMS windows C-F:
|
|
*/
|
|
/* - enable PC Card indexed register space */
|
|
setcsc(CSC_CR, getcsc(CSC_CR) | 0x2);
|
|
/* - set PC Card controller to operate in standard mode */
|
|
setcsc(CSC_PCCMDCR, getcsc(CSC_PCCMDCR) & ~1);
|
|
|
|
/*
|
|
** Program base address and end address of window
|
|
** where the flash ROM should appear in CPU address space
|
|
*/
|
|
setpcc(PCC_MWSAR_1_Lo, (flash_base >> 12) & 0xff);
|
|
setpcc(PCC_MWSAR_1_Hi, (flash_base >> 20) & 0x3f);
|
|
setpcc(PCC_MWEAR_1_Lo, (flash_end >> 12) & 0xff);
|
|
setpcc(PCC_MWEAR_1_Hi, (flash_end >> 20) & 0x3f);
|
|
|
|
/* program offset of first flash location to appear in this window (0) */
|
|
setpcc(PCC_MWAOR_1_Lo, ((0 - flash_base) >> 12) & 0xff);
|
|
setpcc(PCC_MWAOR_1_Hi, ((0 - flash_base)>> 20) & 0x3f);
|
|
|
|
/* set attributes for MMS window C: non-cacheable, write-enabled */
|
|
setcsc(CSC_MMSWAR, getcsc(CSC_MMSWAR) & ~0x11);
|
|
|
|
/* select physical device ROMCS0 (i.e. flash) for MMS Window C */
|
|
setcsc(CSC_MMSWDSR, getcsc(CSC_MMSWDSR) & ~0x03);
|
|
|
|
/* enable memory window 1 */
|
|
setpcc(PCC_AWER_B, getpcc(PCC_AWER_B) | 0x02);
|
|
|
|
/* now disable PC Card indexed register space again */
|
|
setcsc(CSC_CR, getcsc(CSC_CR) & ~0x2);
|
|
}
|
|
|
|
|
|
/*
|
|
************************************************************
|
|
** Disable access to DIL/NetPC's flash by mapping it into
|
|
** the SC4x0's MMS Window C.
|
|
************************************************************
|
|
*/
|
|
static void dnpc_unmap_flash(void)
|
|
{
|
|
/* - enable PC Card indexed register space */
|
|
setcsc(CSC_CR, getcsc(CSC_CR) | 0x2);
|
|
|
|
/* disable memory window 1 */
|
|
setpcc(PCC_AWER_B, getpcc(PCC_AWER_B) & ~0x02);
|
|
|
|
/* now disable PC Card indexed register space again */
|
|
setcsc(CSC_CR, getcsc(CSC_CR) & ~0x2);
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
************************************************************
|
|
** Enable/Disable VPP to write to flash
|
|
************************************************************
|
|
*/
|
|
|
|
static DEFINE_SPINLOCK(dnpc_spin);
|
|
static int vpp_counter = 0;
|
|
/*
|
|
** This is what has to be done for the DNP board ..
|
|
*/
|
|
static void dnp_set_vpp(struct map_info *not_used, int on)
|
|
{
|
|
spin_lock_irq(&dnpc_spin);
|
|
|
|
if (on)
|
|
{
|
|
if(++vpp_counter == 1)
|
|
setcsc(CSC_RBWR, getcsc(CSC_RBWR) & ~0x4);
|
|
}
|
|
else
|
|
{
|
|
if(--vpp_counter == 0)
|
|
setcsc(CSC_RBWR, getcsc(CSC_RBWR) | 0x4);
|
|
else
|
|
BUG_ON(vpp_counter < 0);
|
|
}
|
|
spin_unlock_irq(&dnpc_spin);
|
|
}
|
|
|
|
/*
|
|
** .. and this the ADNP version:
|
|
*/
|
|
static void adnp_set_vpp(struct map_info *not_used, int on)
|
|
{
|
|
spin_lock_irq(&dnpc_spin);
|
|
|
|
if (on)
|
|
{
|
|
if(++vpp_counter == 1)
|
|
setcsc(CSC_RBWR, getcsc(CSC_RBWR) & ~0x8);
|
|
}
|
|
else
|
|
{
|
|
if(--vpp_counter == 0)
|
|
setcsc(CSC_RBWR, getcsc(CSC_RBWR) | 0x8);
|
|
else
|
|
BUG_ON(vpp_counter < 0);
|
|
}
|
|
spin_unlock_irq(&dnpc_spin);
|
|
}
|
|
|
|
|
|
|
|
#define DNP_WINDOW_SIZE 0x00200000 /* DNP flash size is 2MiB */
|
|
#define ADNP_WINDOW_SIZE 0x00400000 /* ADNP flash size is 4MiB */
|
|
#define WINDOW_ADDR FLASH_BASE
|
|
|
|
static struct map_info dnpc_map = {
|
|
.name = "ADNP Flash Bank",
|
|
.size = ADNP_WINDOW_SIZE,
|
|
.bankwidth = 1,
|
|
.set_vpp = adnp_set_vpp,
|
|
.phys = WINDOW_ADDR
|
|
};
|
|
|
|
/*
|
|
** The layout of the flash is somewhat "strange":
|
|
**
|
|
** 1. 960 KiB (15 blocks) : Space for ROM Bootloader and user data
|
|
** 2. 64 KiB (1 block) : System BIOS
|
|
** 3. 960 KiB (15 blocks) : User Data (DNP model) or
|
|
** 3. 3008 KiB (47 blocks) : User Data (ADNP model)
|
|
** 4. 64 KiB (1 block) : System BIOS Entry
|
|
*/
|
|
|
|
static struct mtd_partition partition_info[]=
|
|
{
|
|
{
|
|
.name = "ADNP boot",
|
|
.offset = 0,
|
|
.size = 0xf0000,
|
|
},
|
|
{
|
|
.name = "ADNP system BIOS",
|
|
.offset = MTDPART_OFS_NXTBLK,
|
|
.size = 0x10000,
|
|
#ifdef DNPC_BIOS_BLOCKS_WRITEPROTECTED
|
|
.mask_flags = MTD_WRITEABLE,
|
|
#endif
|
|
},
|
|
{
|
|
.name = "ADNP file system",
|
|
.offset = MTDPART_OFS_NXTBLK,
|
|
.size = 0x2f0000,
|
|
},
|
|
{
|
|
.name = "ADNP system BIOS entry",
|
|
.offset = MTDPART_OFS_NXTBLK,
|
|
.size = MTDPART_SIZ_FULL,
|
|
#ifdef DNPC_BIOS_BLOCKS_WRITEPROTECTED
|
|
.mask_flags = MTD_WRITEABLE,
|
|
#endif
|
|
},
|
|
};
|
|
|
|
#define NUM_PARTITIONS ARRAY_SIZE(partition_info)
|
|
|
|
static struct mtd_info *mymtd;
|
|
static struct mtd_info *lowlvl_parts[NUM_PARTITIONS];
|
|
static struct mtd_info *merged_mtd;
|
|
|
|
/*
|
|
** "Highlevel" partition info:
|
|
**
|
|
** Using the MTD concat layer, we can re-arrange partitions to our
|
|
** liking: we construct a virtual MTD device by concatenating the
|
|
** partitions, specifying the sequence such that the boot block
|
|
** is immediately followed by the filesystem block (i.e. the stupid
|
|
** system BIOS block is mapped to a different place). When re-partitioning
|
|
** this concatenated MTD device, we can set the boot block size to
|
|
** an arbitrary (though erase block aligned) value i.e. not one that
|
|
** is dictated by the flash's physical layout. We can thus set the
|
|
** boot block to be e.g. 64 KB (which is fully sufficient if we want
|
|
** to boot an etherboot image) or to -say- 1.5 MB if we want to boot
|
|
** a large kernel image. In all cases, the remainder of the flash
|
|
** is available as file system space.
|
|
*/
|
|
|
|
static struct mtd_partition higlvl_partition_info[]=
|
|
{
|
|
{
|
|
.name = "ADNP boot block",
|
|
.offset = 0,
|
|
.size = CONFIG_MTD_DILNETPC_BOOTSIZE,
|
|
},
|
|
{
|
|
.name = "ADNP file system space",
|
|
.offset = MTDPART_OFS_NXTBLK,
|
|
.size = ADNP_WINDOW_SIZE-CONFIG_MTD_DILNETPC_BOOTSIZE-0x20000,
|
|
},
|
|
{
|
|
.name = "ADNP system BIOS + BIOS Entry",
|
|
.offset = MTDPART_OFS_NXTBLK,
|
|
.size = MTDPART_SIZ_FULL,
|
|
#ifdef DNPC_BIOS_BLOCKS_WRITEPROTECTED
|
|
.mask_flags = MTD_WRITEABLE,
|
|
#endif
|
|
},
|
|
};
|
|
|
|
#define NUM_HIGHLVL_PARTITIONS ARRAY_SIZE(higlvl_partition_info)
|
|
|
|
|
|
static int dnp_adnp_probe(void)
|
|
{
|
|
char *biosid, rc = -1;
|
|
|
|
biosid = (char*)ioremap(BIOSID_BASE, 16);
|
|
if(biosid)
|
|
{
|
|
if(!strcmp(biosid, ID_DNPC))
|
|
rc = 1; /* this is a DNPC */
|
|
else if(!strcmp(biosid, ID_ADNP))
|
|
rc = 0; /* this is a ADNPC */
|
|
}
|
|
iounmap((void *)biosid);
|
|
return(rc);
|
|
}
|
|
|
|
|
|
static int __init init_dnpc(void)
|
|
{
|
|
int is_dnp;
|
|
|
|
/*
|
|
** determine hardware (DNP/ADNP/invalid)
|
|
*/
|
|
if((is_dnp = dnp_adnp_probe()) < 0)
|
|
return -ENXIO;
|
|
|
|
/*
|
|
** Things are set up for ADNP by default
|
|
** -> modify all that needs to be different for DNP
|
|
*/
|
|
if(is_dnp)
|
|
{ /*
|
|
** Adjust window size, select correct set_vpp function.
|
|
** The partitioning scheme is identical on both DNP
|
|
** and ADNP except for the size of the third partition.
|
|
*/
|
|
int i;
|
|
dnpc_map.size = DNP_WINDOW_SIZE;
|
|
dnpc_map.set_vpp = dnp_set_vpp;
|
|
partition_info[2].size = 0xf0000;
|
|
|
|
/*
|
|
** increment all string pointers so the leading 'A' gets skipped,
|
|
** thus turning all occurrences of "ADNP ..." into "DNP ..."
|
|
*/
|
|
++dnpc_map.name;
|
|
for(i = 0; i < NUM_PARTITIONS; i++)
|
|
++partition_info[i].name;
|
|
higlvl_partition_info[1].size = DNP_WINDOW_SIZE -
|
|
CONFIG_MTD_DILNETPC_BOOTSIZE - 0x20000;
|
|
for(i = 0; i < NUM_HIGHLVL_PARTITIONS; i++)
|
|
++higlvl_partition_info[i].name;
|
|
}
|
|
|
|
printk(KERN_NOTICE "DIL/Net %s flash: 0x%lx at 0x%llx\n",
|
|
is_dnp ? "DNPC" : "ADNP", dnpc_map.size, (unsigned long long)dnpc_map.phys);
|
|
|
|
dnpc_map.virt = ioremap_nocache(dnpc_map.phys, dnpc_map.size);
|
|
|
|
dnpc_map_flash(dnpc_map.phys, dnpc_map.size);
|
|
|
|
if (!dnpc_map.virt) {
|
|
printk("Failed to ioremap_nocache\n");
|
|
return -EIO;
|
|
}
|
|
simple_map_init(&dnpc_map);
|
|
|
|
printk("FLASH virtual address: 0x%p\n", dnpc_map.virt);
|
|
|
|
mymtd = do_map_probe("jedec_probe", &dnpc_map);
|
|
|
|
if (!mymtd)
|
|
mymtd = do_map_probe("cfi_probe", &dnpc_map);
|
|
|
|
/*
|
|
** If flash probes fail, try to make flashes accessible
|
|
** at least as ROM. Ajust erasesize in this case since
|
|
** the default one (128M) will break our partitioning
|
|
*/
|
|
if (!mymtd)
|
|
if((mymtd = do_map_probe("map_rom", &dnpc_map)))
|
|
mymtd->erasesize = 0x10000;
|
|
|
|
if (!mymtd) {
|
|
iounmap(dnpc_map.virt);
|
|
return -ENXIO;
|
|
}
|
|
|
|
mymtd->owner = THIS_MODULE;
|
|
|
|
/*
|
|
** Supply pointers to lowlvl_parts[] array to add_mtd_partitions()
|
|
** -> add_mtd_partitions() will _not_ register MTD devices for
|
|
** the partitions, but will instead store pointers to the MTD
|
|
** objects it creates into our lowlvl_parts[] array.
|
|
** NOTE: we arrange the pointers such that the sequence of the
|
|
** partitions gets re-arranged: partition #2 follows
|
|
** partition #0.
|
|
*/
|
|
partition_info[0].mtdp = &lowlvl_parts[0];
|
|
partition_info[1].mtdp = &lowlvl_parts[2];
|
|
partition_info[2].mtdp = &lowlvl_parts[1];
|
|
partition_info[3].mtdp = &lowlvl_parts[3];
|
|
|
|
mtd_device_register(mymtd, partition_info, NUM_PARTITIONS);
|
|
|
|
/*
|
|
** now create a virtual MTD device by concatenating the for partitions
|
|
** (in the sequence given by the lowlvl_parts[] array.
|
|
*/
|
|
merged_mtd = mtd_concat_create(lowlvl_parts, NUM_PARTITIONS, "(A)DNP Flash Concatenated");
|
|
if(merged_mtd)
|
|
{ /*
|
|
** now partition the new device the way we want it. This time,
|
|
** we do not supply mtd pointers in higlvl_partition_info, so
|
|
** add_mtd_partitions() will register the devices.
|
|
*/
|
|
mtd_device_register(merged_mtd, higlvl_partition_info,
|
|
NUM_HIGHLVL_PARTITIONS);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void __exit cleanup_dnpc(void)
|
|
{
|
|
if(merged_mtd) {
|
|
mtd_device_unregister(merged_mtd);
|
|
mtd_concat_destroy(merged_mtd);
|
|
}
|
|
|
|
if (mymtd) {
|
|
mtd_device_unregister(mymtd);
|
|
map_destroy(mymtd);
|
|
}
|
|
if (dnpc_map.virt) {
|
|
iounmap(dnpc_map.virt);
|
|
dnpc_unmap_flash();
|
|
dnpc_map.virt = NULL;
|
|
}
|
|
}
|
|
|
|
module_init(init_dnpc);
|
|
module_exit(cleanup_dnpc);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Sysgo Real-Time Solutions GmbH");
|
|
MODULE_DESCRIPTION("MTD map driver for SSV DIL/NetPC DNP & ADNP");
|