^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * Copyright © 2001 Flaga hf. Medical Devices, Kári Davíðsson <kd@flaga.is>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * This program is free software; you can redistribute it and/or modify it
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * under the terms of the GNU General Public License as published by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Free Software Foundation; either version 2 of the License, or (at your
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * option) any later version.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) * You should have received a copy of the GNU General Public License along
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) * with this program; if not, write to the Free Software Foundation, Inc.,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) * 675 Mass Ave, Cambridge, MA 02139, USA.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include <linux/mtd/mtd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #include <linux/mtd/map.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #include <linux/mtd/partitions.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) /* We split the flash chip up into four parts.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * 1: bootloader first 128k (0x00000000 - 0x0001FFFF) size 0x020000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) * 2: kernel 640k (0x00020000 - 0x000BFFFF) size 0x0A0000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) * 3: compressed 1536k root ramdisk (0x000C0000 - 0x0023FFFF) size 0x180000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) * 4: writeable diskpartition (jffs)(0x00240000 - 0x003FFFFF) size 0x1C0000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define FLASH_PHYS_ADDR 0x40000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define FLASH_SIZE 0x400000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define FLASH_PARTITION0_ADDR 0x00000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define FLASH_PARTITION0_SIZE 0x00020000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define FLASH_PARTITION1_ADDR 0x00020000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define FLASH_PARTITION1_SIZE 0x000A0000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define FLASH_PARTITION2_ADDR 0x000C0000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define FLASH_PARTITION2_SIZE 0x00180000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) #define FLASH_PARTITION3_ADDR 0x00240000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) #define FLASH_PARTITION3_SIZE 0x001C0000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static struct map_info flagadm_map = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) .name = "FlagaDM flash device",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) .size = FLASH_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) .bankwidth = 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static const struct mtd_partition flagadm_parts[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) .name = "Bootloader",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) .offset = FLASH_PARTITION0_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) .size = FLASH_PARTITION0_SIZE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) .name = "Kernel image",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) .offset = FLASH_PARTITION1_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) .size = FLASH_PARTITION1_SIZE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) .name = "Initial ramdisk image",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) .offset = FLASH_PARTITION2_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) .size = FLASH_PARTITION2_SIZE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) .name = "Persistent storage",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) .offset = FLASH_PARTITION3_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) .size = FLASH_PARTITION3_SIZE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) #define PARTITION_COUNT ARRAY_SIZE(flagadm_parts)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) static struct mtd_info *mymtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) static int __init init_flagadm(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) printk(KERN_NOTICE "FlagaDM flash device: %x at %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) FLASH_SIZE, FLASH_PHYS_ADDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) flagadm_map.phys = FLASH_PHYS_ADDR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) flagadm_map.virt = ioremap(FLASH_PHYS_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) FLASH_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (!flagadm_map.virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) printk("Failed to ioremap\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) simple_map_init(&flagadm_map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) mymtd = do_map_probe("cfi_probe", &flagadm_map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) if (mymtd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) mymtd->owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) mtd_device_register(mymtd, flagadm_parts, PARTITION_COUNT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) printk(KERN_NOTICE "FlagaDM flash device initialized\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) iounmap((void __iomem *)flagadm_map.virt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) static void __exit cleanup_flagadm(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) if (mymtd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) mtd_device_unregister(mymtd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) map_destroy(mymtd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (flagadm_map.virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) iounmap((void __iomem *)flagadm_map.virt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) flagadm_map.virt = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) module_init(init_flagadm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) module_exit(cleanup_flagadm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) MODULE_AUTHOR("Kári Davíðsson <kd@flaga.is>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) MODULE_DESCRIPTION("MTD map driver for Flaga digital module");